Piezoelectric flexible manipulator vibration control based on line structured light and optimized PID

基于线结构光和优化PID的压电柔性机械臂振动控制 Piezoelectric flexible manipulator vibration control based on line structured light and optimized PID 1 2 first-author 马天兵（1981-），男，安徽庐江人，博士，教授，2002年、2005年于安徽理工大学分别获得学士、硕士学位，2014年于南京航空航天大学获得博士学位，现为深部煤矿采动响应与灾害防控国家重点实验室副主任，主要从事机器视觉、振动主动控制方面研究。E-mail：453589872@qq.com http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007428&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007432&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007430&type= 22.01332855 32.00397491 马天兵 （1981-），男，安徽庐江人，博士，教授，2002年、2005年于安徽理工大学分别获得学士、硕士学位，2014年于南京航空航天大学获得博士学位，现为深部煤矿采动响应与灾害防控国家重点实验室副主任，主要从事机器视觉、振动主动控制方面研究。E-mail： 453589872@qq.com 453589872@qq.com 1 2 1 2 corresp E-mail： dfmtb@163.com E-mail： dfmtb@163.com 杜　菲（1981-），女，安徽舒城人，硕士，副教授，2002年于安徽理工大学获得学士学位，2008年于贵州大学获得硕士学位，主要从事微能量回收及振动控制方面研究。E-mail：dfmtb@163.com http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007435&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007441&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007437&type= 22.01332855 32.00401306 杜　菲 （1981-），女，安徽舒城人，硕士，副教授，2002年于安徽理工大学获得学士学位，2008年于贵州大学获得硕士学位，主要从事微能量回收及振动控制方面研究。E-mail： dfmtb@163.com dfmtb@163.com 1 2 1 2 安徽理工大学 深部煤矿采动响应与灾害防控国家重点实验室，安徽 淮南 232001 安徽理工大学 深部煤矿采动响应与灾害防控国家重点实验室，安徽 淮南 232001 State Key Laboratory of Mining Response and Disaster Prevention and Control in Deep Coal Mines， Anhui University of Science and Technology， Huainan 232001， China State Key Laboratory of Mining Response and Disaster Prevention and Control in Deep Coal Mines， Anhui University of Science and Technology， Huainan 232001， China 安徽理工大学 机械工程学院，安徽 淮南 232001 安徽理工大学 机械工程学院，安徽 淮南 232001 School of Mechanical Engineering， Anhui University of Science and Technology， Huainan 232001， China School of Mechanical Engineering， Anhui University of Science and Technology， Huainan 232001， China 针对单目相机无法感知三维深度信息、双目立体视觉在被测物表面特征不明显时存在局限性以及PID控制器参数整定不理想等问题，将线结构光技术应用于柔性臂的振动检测，并利用细菌觅食算法优化的PID对其进行振动控制。首先搭建了线结构光视觉测振系统，建立了数学模型，完成了视觉标定，验证了该方法的可行性与准确性；然后利用细菌觅食算法对PID控制器进行了参数优化，与经验整定法进行了仿真效果对比；最后进行了柔性臂振动主动控制实验。实验结果表明，针对柔性臂的一阶模态振动，利用经验法整定的PID控制方法平均控制效果为25.65%，而利用细菌觅食算法优化的PID控制方法平均控制效果为39.32%，验证了细菌觅食算法优化PID控制器参数的优越性。 It is difficult for three-dimensional （3D） depth information to be detected by monocular cameras， and there are limitations of binocular stereo vision when the surface features are not apparent. In addition， the proportional-integral derivative （PID） controller parameter tuning is not ideal. To address this， linear structured light technology is used to detect vibrations of the flexible manipulator， and the bacterial foraging algorithm is used to optimize the PID for vibration control. First， a linear structured light visual vibration measurement system is developed， and a mathematical model is established. Then， the visual calibration is completed， and the feasibility and accuracy of the proposed method are verified. By using the bacterial foraging algorithm， the parameters of the PID controller are optimized， the simulation results are compared with the results of the empirical tuning method， and the active vibration control experiment of the flexible manipulator is performed. Experimental results show that for the first-order modal vibration of the flexible manipulator， the average effect of the PID control method based on the empirical method control is 25.65% compared with the average effect of 39.32% when using the bacterial foraging algorithm. Consequently， the superiority of the proposed bacterial foraging algorithm when optimizing PID controller parameters is demonstrated. 柔性机械臂 线结构光 PID控制 细菌觅食算法 双目立体视觉 flexible manipulator line structured light PID control bacterial foraging optimization algorithm binocular stereo vision 1 引　言 1 随着材料和科学技术的进步，工程领域正在推出重量轻、体积小、性能高的产品，使得机器人系统更加智能化。追求更紧凑、更柔性的结构使得系统具有更大的灵活性的同时也带来了棘手的控制问题。 常用的接触式测量方法实现振动测量的过程须始终保持传感器与被测物接触，改变了被测物的结构特性，给测量结果造成了一定的误差，且无法实现多点同时测量。非接触式测量方法恰好弥补了这一缺陷，伴随着计算机和图像处理技术的发展，机器视觉技术在振动检测中的应用也越来越普遍。徐秀秀等 ［ 1 1 ］ 设计了一种基于机器视觉的柔性臂振动测量系统，实现了柔性臂的振动位移检测。徐超等 ［ 2 2 ］ 将视觉测量法运用于大柔性结构的振动测量之中，取得了较好的测量效果。邱志成等 ［ 3 3 -4］ 利用双目视觉获得其柔性板振动信息，提出了一种新型线结构光视觉系统标定方法实现了柔性臂的测振。彭聪等 ［ 5 5 ］ 将基于视频相位的振动测量方法与双目立体视觉相结合，设计了一种基于机器视觉的三维测振方法，并利用该方法对悬臂梁进行了振动位移检测。然而上述基于单目相机的视觉检测无法获得物体表面的三维信息，双目立体视觉检测在被测物表面特征不明显时使用受到限制。 在振动控制系统中，控制策略是控制的关键 ［ 6 6 - 7 7 6-7 ］ 。PID控制算法以其原理简单、适应性强和可靠性高在运动控制领域得到广泛运用，PID控制器的好坏在于控制参数的选择，常规PID参数整定方法有经验法和响应曲线法等，然而使用这类方法进行参数的整定，其整定过程繁杂且精度不高。后来研究学者们为提高控制器参数整定精度和效率，又发展了一系列智能参数整定方法。曹青松等 ［ 8 8 ］ 利用模糊自整定PID算法对两自由度压电柔性机械臂的振动进行了主动控制研究。张娟等 ［ 9 9 ］ 利用改进的遗传算法对压电片位置、长度及PID控制器参数进行了优化选取。改进的PID算法不仅操作方便，效率高，还提升了系统整体控制性能。 综上，本文以刚柔双关节机械臂作为研究对象，设计基于线结构光和优化PID的振动控制系统。首先搭建线结构光视觉测振系统并对其进行可行性与准确性验证；然后利用细菌觅食算法对PID控制器进行参数优化；最后设计实验对控制算法的控制效果加以验证。提出的新方法可实现强干扰背景下柔性臂振动位移的视觉特征有效提取和高效控制。 2 控制实验系统 1 2.1　系统构成 2 图1 图1 所示为整个控制系统的构成示意图。两臂杆在电机驱动下运动，相机与线激光器构成的线结构光视觉系统获取柔性臂末端实时振动位移，并将其作为优化后PID控制器的输入，控制器输出信号由数据输出卡输出经功率放大器的放大作用于压电作动片，实现柔性臂的振动主动控制。 2.2　实验装置 2 图2 图2 为控制系统的装置实物图。柔性臂为长 <math id="M1"><mn mathvariant="normal">300</mn><mtext> </mtext><mi mathvariant="normal">m</mi><mi mathvariant="normal">m</mi></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007453&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007451&type= 12.19200039 2.87866688 ，截面尺寸为 <math id="M2"><mn mathvariant="normal">15</mn><mtext> </mtext><mi mathvariant="normal">m</mi><mi mathvariant="normal">m</mi><mo>×</mo><mn mathvariant="normal">1</mn><mtext> </mtext><mi mathvariant="normal">m</mi><mi mathvariant="normal">m</mi></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007458&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007456&type= 23.70666695 2.87866688 的不锈钢材料，对应驱动电机型号为J-4218HB2403的步进电机（下文记作小电机）；刚性臂为长 <math id="M3"><mn mathvariant="normal">200</mn><mtext> </mtext><mi mathvariant="normal">m</mi><mi mathvariant="normal">m</mi></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007464&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007460&type= 12.27666664 2.87866688 ，截面尺寸为 <math id="M4"><mn mathvariant="normal">15</mn><mtext> </mtext><mi mathvariant="normal">m</mi><mi mathvariant="normal">m</mi><mo>×</mo><mn mathvariant="normal">6</mn><mtext> </mtext><mi mathvariant="normal">m</mi><mi mathvariant="normal">m</mi></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007468&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007466&type= 23.70666695 2.87866688 的碳钢材料，对应驱动电机型号为J-5718HB3401的步进电机（下文记作大电机）；电控箱中配有电源以及步进电机的控制器与驱动器；压电作动片选择22 mm×19.5 mm的压电陶瓷单晶片，极板面积为18 mm×18 mm，压电常数 <math id="M5"><mi>d</mi><mn mathvariant="normal">31</mn><mo>=</mo><mn mathvariant="normal">220</mn><mo>×</mo><msup><mrow><mn mathvariant="normal">10</mn></mrow><mrow><mo>-</mo><mn mathvariant="normal">12</mn></mrow></msup><mtext> </mtext><mi mathvariant="normal">C</mi><mo>/</mo><mi mathvariant="normal">N</mi></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007472&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007470&type= 36.66066742 3.47133350 ，两表面极板间距离 <math id="M6"><mi>d</mi><mo>=</mo><mn mathvariant="normal">0.2</mn><mtext> </mtext><mi mathvariant="normal">m</mi><mi mathvariant="normal">m</mi></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007477&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007474&type= 18.45733452 2.87866688 ，粘贴于柔性臂根部；数据输出卡型号为USB-6003，电压输出在 - 10 V~10 V的范围内；功率放大器型号为HVD-300D；相机选择Imaging Source公司的DMK33G618 CCD相机，分辨率为 <math id="M7"><mn mathvariant="normal">640</mn><mo>×</mo><mn mathvariant="normal">480</mn></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007482&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007480&type= 16.00200081 2.79399991 ，最高帧率为 <math id="M8"><mn mathvariant="normal">120</mn><mtext> </mtext><mi mathvariant="normal">H</mi><mi mathvariant="normal">z</mi></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007486&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007484&type= 10.75266743 2.87866688 ，镜头焦距为 <math id="M9"><mn mathvariant="normal">16</mn><mtext> </mtext><mi mathvariant="normal">m</mi><mi mathvariant="normal">m</mi></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007489&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007487&type= 10.41399956 2.87866688 ；线激光器采用型号为HW650AB100-16GD-WLD的红光一字线激光器。选择一块轻质泡沫板作为目标平面，并将其设置在柔性臂末端位置处（目标平面的设计后文会具体介绍），线激光器和工业相机分别布置在小电机关节左右两侧，且保证相机光轴与激光器中心轴线的交点基本位于泡沫板中心。 3 测振系统数学模型与标定 1 3.1　线结构光视觉模型 2 线结构光三维测量系统主要由计算机、工业相机、线激光器、被测对象组成。其基本工作原理如 图3 图3 所示。激光发射器打出激光平面并在目标平面上形成激光条纹，激光条纹通过相机拍摄在相机的感光平面上成像，通过计算机提取激光条纹的中心像素坐标，再结合线结构光视觉系统模型，将其转换为三维坐标，完成特征点的三维重建。 在相机模型中，存在三大坐标系，分别为图像坐标系 <math id="M10"><msub><mrow><mi>O</mi></mrow><mrow><mn mathvariant="normal">1</mn></mrow></msub><mo>-</mo><mi>X</mi><mi>Y</mi></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007506&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007505&type= 14.39333248 3.72533321 、相机坐标系 <math id="M11"><mi>O</mi><mo>-</mo><msub><mrow><mi>X</mi></mrow><mrow><mi>c</mi></mrow></msub><msub><mrow><mi>Y</mi></mrow><mrow><mi>c</mi></mrow></msub><msub><mrow><mi>Z</mi></mrow><mrow><mi>c</mi></mrow></msub></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007511&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007508&type= 18.71133423 3.72533321 及世界坐标系 <math id="M12"><msub><mrow><mi>O</mi></mrow><mrow><mi>w</mi></mrow></msub><mo>-</mo><msub><mrow><mi>X</mi></mrow><mrow><mi>w</mi></mrow></msub><msub><mrow><mi>Y</mi></mrow><mrow><mi>w</mi></mrow></msub><msub><mrow><mi>Z</mi></mrow><mrow><mi>w</mi></mrow></msub></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007515&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007513&type= 22.69066620 3.72533321 。空间中任一点的世界坐标 <math id="M13"><mo stretchy="false">(</mo><msub><mrow><mi>X</mi></mrow><mrow><mi>w</mi></mrow></msub><mo>,</mo><msub><mrow><mi>Y</mi></mrow><mrow><mi>w</mi></mrow></msub><mo>,</mo><msub><mrow><mi>Z</mi></mrow><mrow><mi>w</mi></mrow></msub><mo stretchy="false">)</mo></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007519&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007517&type= 20.15066719 4.48733330 、相机坐标 <math id="M14"><mo stretchy="false">(</mo><msub><mrow><mi>X</mi></mrow><mrow><mi>c</mi></mrow></msub><mo>,</mo><msub><mrow><mi>Y</mi></mrow><mrow><mi>c</mi></mrow></msub><mo>,</mo><msub><mrow><mi>Z</mi></mrow><mrow><mi>c</mi></mrow></msub><mo stretchy="false">)</mo></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007523&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007521&type= 17.94933319 4.48733330 及其成像点的像素坐标 <math id="M15"><mfenced separators="|"><mrow><mi>u</mi><mo>,</mo><mi>v</mi></mrow></mfenced></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007528&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007525&type= 8.63599968 3.97933316 之间存在如下关系： <math display="block" id="M16"><msub><mrow><mi>Z</mi></mrow><mrow><mi>c</mi></mrow></msub><mfenced separators="|"><mrow><mtable><mtr><mtd><mi>u</mi></mtd></mtr><mtr><mtd><mi>v</mi></mtd></mtr><mtr><mtd><mn mathvariant="normal">1</mn></mtd></mtr></mtable></mrow></mfenced><mo>=</mo><mfenced separators="|"><mrow><mtable><mtr><mtd><msub><mrow><mi>f</mi></mrow><mrow><mi>u</mi></mrow></msub></mtd><mtd><mn mathvariant="normal">0</mn></mtd><mtd><mtable><mtr><mtd><msub><mrow><mi>u</mi></mrow><mrow><mn mathvariant="normal">0</mn></mrow></msub></mtd><mtd><mn mathvariant="normal">0</mn></mtd></mtr></mtable></mtd></mtr><mtr><mtd><mn mathvariant="normal">0</mn></mtd><mtd><msub><mrow><mi>f</mi></mrow><mrow><mi>v</mi></mrow></msub></mtd><mtd><mtable><mtr><mtd><msub><mrow><mi>v</mi></mrow><mrow><mn mathvariant="normal">0</mn></mrow></msub></mtd><mtd><mn mathvariant="normal">0</mn></mtd></mtr></mtable></mtd></mtr><mtr><mtd><mn mathvariant="normal">0</mn></mtd><mtd><mn mathvariant="normal">0</mn></mtd><mtd><mtable><mtr><mtd><mn mathvariant="normal">1</mn></mtd><mtd><mn mathvariant="normal">0</mn></mtd></mtr></mtable></mtd></mtr></mtable></mrow></mfenced><mfenced separators="|"><mrow><mtable><mtr><mtd><msub><mrow><mi>X</mi></mrow><mrow><mi>c</mi></mrow></msub></mtd></mtr><mtr><mtd><msub><mrow><mi>Y</mi></mrow><mrow><mi>c</mi></mrow></msub></mtd></mtr><mtr><mtd><msub><mrow><mi>Z</mi></mrow><mrow><mi>c</mi></mrow></msub></mtd></mtr><mtr><mtd><mn mathvariant="normal">1</mn></mtd></mtr></mtable></mrow></mfenced></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007534&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007531&type= 47.15933609 18.45733452 ， <math display="block" id="M17"><mfenced separators="|"><mrow><mtable><mtr><mtd><msub><mrow><mi>X</mi></mrow><mrow><mi>c</mi></mrow></msub></mtd></mtr><mtr><mtd><msub><mrow><mi>Y</mi></mrow><mrow><mi>c</mi></mrow></msub></mtd></mtr><mtr><mtd><msub><mrow><mi>Z</mi></mrow><mrow><mi>c</mi></mrow></msub></mtd></mtr><mtr><mtd><mn mathvariant="normal">1</mn></mtd></mtr></mtable></mrow></mfenced><mo>=</mo><mfenced separators="|"><mrow><mtable><mtr><mtd><mi mathvariant="bold-italic">R</mi></mtd><mtd><mi mathvariant="bold-italic">T</mi></mtd></mtr><mtr><mtd><msup><mrow><mn mathvariant="normal">0</mn></mrow><mrow><mi>T</mi></mrow></msup></mtd><mtd><mn mathvariant="normal">1</mn></mtd></mtr></mtable></mrow></mfenced><mfenced separators="|"><mrow><mtable><mtr><mtd><msub><mrow><mi>X</mi></mrow><mrow><mi>w</mi></mrow></msub></mtd></mtr><mtr><mtd><msub><mrow><mi>Y</mi></mrow><mrow><mi>w</mi></mrow></msub></mtd></mtr><mtr><mtd><msub><mrow><mi>Z</mi></mrow><mrow><mi>w</mi></mrow></msub></mtd></mtr><mtr><mtd><mn mathvariant="normal">1</mn></mtd></mtr></mtable></mrow></mfenced></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007538&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007536&type= 34.62866592 18.45733452 ， 其中： <math id="M18"><mo stretchy="false">(</mo><msub><mrow><mi>f</mi></mrow><mrow><mi>u</mi></mrow></msub><mo>,</mo><msub><mrow><mi>f</mi></mrow><mrow><mi>v</mi></mrow></msub><mo stretchy="false">)</mo></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007542&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007540&type= 10.32933331 4.91066647 为归一化焦距， <math id="M19"><mo stretchy="false">(</mo><msub><mrow><mi>u</mi></mrow><mrow><mn mathvariant="normal">0</mn></mrow></msub><mo>,</mo><msub><mrow><mi>v</mi></mrow><mrow><mn mathvariant="normal">0</mn></mrow></msub><mo stretchy="false">)</mo></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007547&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007544&type= 11.09133339 4.48733330 为图像平面上主点坐标， <math id="M20"><mi mathvariant="bold-italic">R</mi></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007553&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007550&type= 2.70933342 2.79399991 和 <math id="M21"><mi mathvariant="bold-italic">T</mi></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007557&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007555&type= 2.62466669 2.79399991 分别为旋转矩阵和平移向量。 激光平面模型即为其在相机坐标系下的平面方程表达式，记作： <math display="block" id="M22"><mi>A</mi><msub><mrow><mi>X</mi></mrow><mrow><mi>c</mi></mrow></msub><mo>+</mo><mi>B</mi><msub><mrow><mi>Y</mi></mrow><mrow><mi>c</mi></mrow></msub><mo>+</mo><mi>C</mi><msub><mrow><mi>Z</mi></mrow><mrow><mi>c</mi></mrow></msub><mo>+</mo><mi>D</mi><mo>=</mo><mn mathvariant="normal">0</mn></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007561&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007559&type= 42.58732986 3.80999994 ， 其中： A ， B ， C ， D 为拟合光平面系数。当相机模型和激光平面模型确定，并已知某点的像素坐标，联立 式（1） 式（1） 、 式（3） 式（3） ，便可得到该点在相机坐标系下的三维坐标，完成其三维重建。 3.2　标定原理 2 线结构光视觉系统标定包括相机标定和线结构光平面标定两部分。张正友 ［ 10 10 ］ 提出利用平面棋盘格进行相机标定，精度高、鲁棒性好、应用广，本文采用该方法进行相机标定。本文利用文献［ 11 11 ］提出的方法进行线结构光平面标定。该方法标定原理为：首先提取光条直线特征点，利用其在归一化图像平面内的投影点在相机坐标系下的坐标值，计算出过相机光心和特征点所在直线方程；然后根据棋盘靶标的特点计算该靶标平面在相机坐标系下的方程；接着利用上述直线方程和平面方程，得到特征点在相机坐标系下的坐标值，同理可获得光条直线上所有特征点坐标值；最后通过多次调整标定板位姿，获取不同光条特征点坐标，并利用最小二乘法对所有特征点进行平面拟合得到光平面方程。 标定图像采集过程如下： （1）将棋盘格标定板放置在柔性臂末端处，保证相机和激光器相对位置不变。调节相机镜头的焦距和光圈，使棋盘格在相机视场内清晰成像，此时固定镜头焦距和光圈； （2）打开激光器，使激光条纹落在棋盘格一侧黑色区域，拍摄一张标定图像； （3）关闭激光器，保持棋盘格标定板位置不变，拍摄一张标定图像； （4）调整棋盘格标定板位姿，重复步骤（2）和（3），依次拍摄4组标定图像。至此，用于激光平面标定的图像采集完毕，共5张标定图像； （5）保持激光器始终关闭，依次调整棋盘格标定板位姿，并拍摄14张标定图像。至此，用于相机标定的图像采集完毕，共19张标定图像。 4 基于细菌觅食的PID控制器设计 1 PID ［ 12 12 ］ 作为一种被普遍采用的控制方法，将被控对象的实时响应与给定目标值的偏差 <math id="M23"><mi>e</mi><mo stretchy="false">(</mo><mi>t</mi><mo stretchy="false">)</mo></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007566&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007563&type= 6.34999990 3.55599999 作为控制器的输入，然后将偏差的比例、积分和微分通过线性组合构成控制量 <math id="M24"><mi>u</mi><mo stretchy="false">(</mo><mi>t</mi><mo stretchy="false">)</mo></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007570&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007569&type= 6.68866634 3.55599999 ，其控制规律为： <math display="block" id="M25"><mi>u</mi><mo stretchy="false">(</mo><mi>t</mi><mo stretchy="false">)</mo><mo>=</mo><msub><mrow><mi>k</mi></mrow><mrow><mi>p</mi></mrow></msub><mi>e</mi><mo stretchy="false">(</mo><mi>t</mi><mo stretchy="false">)</mo><mo>+</mo><msub><mrow><mi>k</mi></mrow><mrow><mi>i</mi></mrow></msub><msubsup><mo>∫</mo><mrow><mn mathvariant="normal">0</mn></mrow><mrow><mi>t</mi></mrow></msubsup><mrow><mi>e</mi><mo stretchy="false">(</mo><mi>t</mi><mo stretchy="false">)</mo><mi mathvariant="normal">d</mi><mi>t</mi><mo>+</mo><msub><mrow><mi>k</mi></mrow><mrow><mi>d</mi></mrow></msub></mrow><mfrac><mrow><mi mathvariant="normal">d</mi><mi>e</mi><mo stretchy="false">(</mo><mi>t</mi><mo stretchy="false">)</mo></mrow><mrow><mi mathvariant="normal">d</mi><mi>t</mi></mrow></mfrac></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007575&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007573&type= 58.84333038 8.29733276 ， 其中： <math id="M26"><msub><mrow><mi>k</mi></mrow><mrow><mi>p</mi></mrow></msub></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007579&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007576&type= 2.79399991 3.72533321 ， <math id="M27"><msub><mrow><mi>k</mi></mrow><mrow><mi>i</mi></mrow></msub></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007632&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007629&type= 2.45533323 3.72533321 ， <math id="M28"><msub><mrow><mi>k</mi></mrow><mrow><mi>d</mi></mrow></msub></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007639&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007635&type= 2.96333337 3.72533321 分别表示控制器的比例系数，积分系数及微分系数，均为可调节量。 细菌觅食优化算法（Bacteria Foraging Optimization Algorithm，BFOA） ［ 13 13 ］ 是由Passino于2002年通过模拟人类大肠杆菌觅食行为提出的一种新的群体智能优化算法。大肠杆菌觅食过程实质就是在其自身生理和外在环境约束下进行移动使获得能量最大化的一种行为。细菌主要通过趋向性操作、聚集性操作、复制操作和迁徙操作来完成觅食行为。 为得到柔性臂振动控制系统中最优的PID控制器，利用上述智能算法对其进行参数优化。 具体优化步骤如下： （1）设计PID控制器仿真控制系统，将被控对象的实时响应与给定目标值的偏差绝对值之和作为函数适应度； （2）用PID控制器参数 <math id="M29"><msub><mrow><mi>k</mi></mrow><mrow><mi>p</mi></mrow></msub></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007909&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007905&type= 2.79399991 3.72533321 ， <math id="M30"><msub><mrow><mi>k</mi></mrow><mrow><mi>i</mi></mrow></msub></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007632&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007629&type= 2.45533323 3.72533321 ， <math id="M31"><msub><mrow><mi>k</mi></mrow><mrow><mi>d</mi></mrow></msub></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007608&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007605&type= 2.96333337 3.72533321 表示细菌个体位置，并随机初始化种群中各细菌的位置； （3）进行控制仿真，计算初始位置细菌的适应度 <math id="M32"><mi>J</mi></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007645&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007641&type= 1.60866666 2.79399991 ，并将当前细菌的适应度保存为 <math id="M33"><msub><mrow><mi>J</mi></mrow><mrow><mi mathvariant="normal">l</mi><mi mathvariant="normal">a</mi><mi mathvariant="normal">s</mi><mi mathvariant="normal">t</mi></mrow></msub></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007621&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007619&type= 4.48733330 3.72533321 ； （4）对每个细菌进行趋向、聚集、复制和迁徙操作，得到新的 <math id="M34"><msub><mrow><mi>k</mi></mrow><mrow><mi>p</mi></mrow></msub></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007626&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007624&type= 2.79399991 3.72533321 ， <math id="M35"><msub><mrow><mi>k</mi></mrow><mrow><mi>i</mi></mrow></msub></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007632&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007629&type= 2.45533323 3.72533321 ， <math id="M36"><msub><mrow><mi>k</mi></mrow><mrow><mi>d</mi></mrow></msub></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007639&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007635&type= 2.96333337 3.72533321 ，再次进行控制仿真得到新位置细菌的适应度 <math id="M37"><mi>J</mi></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007645&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007641&type= 1.60866666 2.79399991 ，并根据判断条件及时更新 <math id="M38"><msub><mrow><mi>J</mi></mrow><mrow><mi>l</mi><mi>a</mi><mi>s</mi><mi>t</mi></mrow></msub></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007651&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007648&type= 4.57200003 3.72533321 ； （5）判断是否达到最大迭代次数，若是，终止迭代，输出最优解，否则重复步骤（4）。 5 控制器参数仿真 1 5.1　模态参数获取 2 为了完成PID控制器参数的优化，需要构建柔性双关节机械臂的振动控制仿真系统，系统包括PID控制器、目标函数、状态方程及激励响应，在电机驱动下，柔性臂杆产生振动响应，响应与目标函数的差值作为控制器输入，控制器输出控制柔性臂杆。其中，电机激励下的柔性臂杆响应模型，利用拉格朗日方程及假定模态法建立，并考虑关节柔性进行模型修正 ［ 14 14 ］ ，模型中参数采用实验平台参数进行设置，得到模型的电机激励响应结果如 图4 图4 所示。 将柔性臂近似为悬臂梁结构，其状态空间方程为： <math display="block" id="M39"><mover accent="true"><mi mathvariant="bold-italic">X</mi><mo>˙</mo></mover><mo>=</mo><mfenced open="[" close="]" separators="|"><mrow><mtable><mtr><mtd><mn mathvariant="normal">0</mn></mtd><mtd><mn mathvariant="normal">1</mn></mtd></mtr><mtr><mtd><mo>-</mo><mi mathvariant="bold-italic">K</mi><msup><mrow><mi mathvariant="bold-italic">M</mi></mrow><mrow><mo>-</mo><mn mathvariant="normal">1</mn></mrow></msup></mtd><mtd><mo>-</mo><mi mathvariant="bold-italic">C</mi><msup><mrow><mi mathvariant="bold-italic">M</mi></mrow><mrow><mo>-</mo><mn mathvariant="normal">1</mn></mrow></msup></mtd></mtr></mtable></mrow></mfenced><mi mathvariant="bold-italic">X</mi><mo>+</mo><mfenced open="[" close="]" separators="|"><mrow><mtable><mtr><mtd><mn mathvariant="normal">0</mn></mtd></mtr><mtr><mtd><mo>-</mo><mi>δ</mi><msup><mrow><mi mathvariant="bold-italic">M</mi></mrow><mrow><mo>-</mo><mn mathvariant="normal">1</mn></mrow></msup></mtd></mtr></mtable></mrow></mfenced><mi mathvariant="bold-italic">u</mi></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007666&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007662&type= 66.12466431 8.63599968 ， 其中： <math id="M40"><mi mathvariant="bold-italic">K</mi></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007671&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007669&type= 2.79399991 2.79399991 ， <math id="M41"><mi mathvariant="bold-italic">M</mi></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007678&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007674&type= 3.47133350 2.96333337 ， <math id="M42"><mi mathvariant="bold-italic">C</mi></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007685&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007682&type= 2.53999996 2.79399991 为系统的固有属性，依次为模态刚度、模态质量、模态阻尼； <math id="M43"><mi>δ</mi></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007691&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007688&type= 1.94733346 2.79399991 为力因子； <math id="M44"><mi mathvariant="bold-italic">u</mi></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007695&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007693&type= 2.11666679 2.79399991 为系统的输入向量，即控制电压； <math id="M45"><mi mathvariant="bold-italic">X</mi></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007701&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007699&type= 2.70933342 2.79399991 为系统的输出矩阵，即振动位移。 若仅考虑系统的一阶振动模态， <math id="M46"><mi>k</mi></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007707&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007706&type= 1.69333339 2.79399991 、 <math id="M47"><mi>m</mi></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007713&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007710&type= 2.79399991 2.79399991 、 <math id="M48"><mi>c</mi></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007725&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007722&type= 1.52400005 2.79399991 之间的关系可表示为： <math display="block" id="M49"><mfenced open="{" close="" separators="|"><mrow><mtable><mtr><mtd><mn mathvariant="normal">2</mn><mi>ξ</mi><msub><mrow><mi>ω</mi></mrow><mrow><mi>n</mi></mrow></msub><mo>=</mo><mfrac><mrow><mi>c</mi></mrow><mrow><mi>m</mi></mrow></mfrac></mtd></mtr><mtr><mtd><msup><mrow><msub><mrow><mi>ω</mi></mrow><mrow><mi>n</mi></mrow></msub></mrow><mrow><mn mathvariant="normal">2</mn></mrow></msup><mo>=</mo><mfrac><mrow><mi>k</mi></mrow><mrow><mi>m</mi></mrow></mfrac></mtd></mtr></mtable></mrow></mfenced></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007731&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007728&type= 17.44133186 18.79599953 ， 其中： <math id="M50"><mi>ξ</mi></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007819&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007815&type= 1.60866666 3.64066648 为阻尼比， <math id="M51"><msub><mrow><mi>ω</mi></mrow><mrow><mi>n</mi></mrow></msub></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007811&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007807&type= 3.64066648 3.72533321 为一阶固有频率。 根据上述公式可知，柔性臂杆的状态方程，可通过结构阻尼比以及固有频率进行求解，而阻尼比以及固有频率，可利用扫频激励实验进行获取。利用上节测振系统，实验中信号发生器设置输出时间为8 s、频率范围为1~10 Hz的正弦扫频信号，测振程序采样频率设置为90 Hz，振动位移测量结果如 图5 图5 所示。对振动位移进行频谱分析，结果如 图6 图6 所示。 由 图6 图6 可知，系统的峰值频率 <math id="M52"><mi>f</mi><mo>=</mo><mn mathvariant="normal">5.2</mn><mtext> </mtext><mi mathvariant="normal">H</mi><mi mathvariant="normal">z</mi></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007767&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007764&type= 15.91733265 3.64066648 ，故其固有频率 <math id="M53"><msub><mrow><mi>ω</mi></mrow><mrow><mi>n</mi></mrow></msub><mo>=</mo><mn mathvariant="normal">2</mn><mi mathvariant="normal">π</mi><mi>f</mi><mo>=</mo><mn mathvariant="normal">32.673</mn><mtext> </mtext><mi mathvariant="normal">H</mi><mi mathvariant="normal">z</mi></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007773&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007770&type= 33.78200150 4.57200003 ； <math id="M54"><mi>y</mi><mo>=</mo><mn mathvariant="normal">0.126</mn><mtext> </mtext><mn mathvariant="normal">1</mn></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007779&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007776&type= 17.78000069 3.72533321 为过频谱曲线峰值 <math id="M55"><mrow><mrow><mn mathvariant="normal">1</mn></mrow><mo>/</mo><mrow><mroot><mrow><mn mathvariant="normal">2</mn></mrow><mrow/></mroot></mrow></mrow></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007785&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007782&type= 8.72066593 4.48733330 倍的一条水平直线，该直线与频谱曲线相交于两点，对应频率分别为 <math id="M56"><msub><mrow><mi>f</mi></mrow><mrow><mn mathvariant="normal">1</mn></mrow></msub><mo>=</mo><mn mathvariant="normal">5.018</mn><mtext> </mtext><mi mathvariant="normal">H</mi><mi mathvariant="normal">z</mi></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007791&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007788&type= 20.74333191 4.57200003 ， <math id="M57"><msub><mrow><mi>f</mi></mrow><mrow><mn mathvariant="normal">2</mn></mrow></msub><mo>=</mo><mn mathvariant="normal">5.267</mn><mtext> </mtext><mi mathvariant="normal">H</mi><mi mathvariant="normal">z</mi></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007796&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007793&type= 20.74333191 4.57200003 。由半功率带宽法求得系统阻尼比： <math display="block" id="M58"><mi>ξ</mi><mo>=</mo><mfrac><mrow><msub><mrow><mi>f</mi></mrow><mrow><mn mathvariant="normal">2</mn></mrow></msub><mo>-</mo><msub><mrow><mi>f</mi></mrow><mrow><mn mathvariant="normal">1</mn></mrow></msub></mrow><mrow><mn mathvariant="normal">2</mn><mi>f</mi></mrow></mfrac><mo>=</mo><mn mathvariant="normal">0.023</mn><mtext> </mtext><mn mathvariant="normal">9</mn></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007803&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007800&type= 32.59666443 8.80533314 ， 已知 <math id="M59"><msub><mrow><mi>ω</mi></mrow><mrow><mi>n</mi></mrow></msub></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007811&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007807&type= 3.64066648 3.72533321 和 <math id="M60"><mi>ξ</mi></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007819&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007815&type= 1.60866666 3.64066648 ，现只需确定 <math id="M61"><mo>-</mo><mi>δ</mi><msup><mrow><mi mathvariant="bold-italic">M</mi></mrow><mrow><mo>-</mo><mn mathvariant="normal">1</mn></mrow></msup></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007840&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007837&type= 12.10733318 3.13266683 的值即可获得系统的状态空间方程。这里将实验结果与仿真结果进行对比求取 <math id="M62"><mo>-</mo><mi>δ</mi><msup><mrow><mi mathvariant="bold-italic">M</mi></mrow><mrow><mo>-</mo><mn mathvariant="normal">1</mn></mrow></msup></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007834&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007830&type= 12.10733318 3.13266683 ，不断调整参数，最终确定当 <math id="M63"><mo>-</mo><mi>δ</mi><msup><mrow><mi mathvariant="bold-italic">M</mi></mrow><mrow><mo>-</mo><mn mathvariant="normal">1</mn></mrow></msup></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007840&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007837&type= 12.10733318 3.13266683 的值为1.2时，仿真系统输出与实验响应一致。综合上述实验结果及 公式（6） 公式（6） ，最终得到其空间状态方程为： <math display="block" id="M64"><mover accent="true"><mi mathvariant="bold-italic">X</mi><mo>˙</mo></mover><mo>=</mo><mfenced open="[" close="]" separators="|"><mrow><mtable><mtr><mtd><mn mathvariant="normal">0</mn></mtd><mtd><mn mathvariant="normal">1</mn></mtd></mtr><mtr><mtd><mo>-</mo><mn mathvariant="normal">1067.495</mn></mtd><mtd><mo>-</mo><mn mathvariant="normal">1.5618</mn></mtd></mtr></mtable></mrow></mfenced><mi mathvariant="bold-italic">X</mi><mo>+</mo><mfenced open="[" close="]" separators="|"><mrow><mtable><mtr><mtd><mn mathvariant="normal">0</mn></mtd></mtr><mtr><mtd><mn mathvariant="normal">1.2</mn></mtd></mtr></mtable></mrow></mfenced><mi mathvariant="bold-italic">u</mi></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007848&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007844&type= 64.51599884 8.55133343 . 5.2　仿真控制结果 2 利用MATLAB中m文件编写细菌觅食算法和适应度函数，细菌觅食算法各参数依次设置如下：种群搜索范围 <math id="M65"><mi mathvariant="normal">b</mi><mi mathvariant="normal">o</mi><mi mathvariant="normal">u</mi><mi mathvariant="normal">n</mi><mi mathvariant="normal">d</mi><mi mathvariant="normal">s</mi><mo>=</mo><mo stretchy="false">[</mo><mn mathvariant="normal">0,10</mn><mo>;</mo><mn mathvariant="normal">0,10</mn><mo>;</mo><mn mathvariant="normal">0,10</mn><mo stretchy="false">]</mo></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007853&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007849&type= 44.95800018 3.55599999 ；细菌个数 <math id="M66"><mi>s</mi><mo>=</mo><mn mathvariant="normal">26</mn></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007863&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007857&type= 9.82133293 2.79399991 ，趋化次数 <math id="M67"><msub><mrow><mi>N</mi></mrow><mrow><mi>c</mi></mrow></msub><mo>=</mo><mn mathvariant="normal">50</mn></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007871&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007867&type= 12.36133385 3.80999994 ，趋向操作单向运动最大步数 <math id="M68"><msub><mrow><mi>N</mi></mrow><mrow><mi>s</mi></mrow></msub><mo>=</mo><mn mathvariant="normal">4</mn></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007879&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007875&type= 10.41399956 3.80999994 ，复制次数 <math id="M69"><msub><mrow><mi>N</mi></mrow><mrow><mi mathvariant="normal">r</mi><mi mathvariant="normal">e</mi></mrow></msub><mo>=</mo><mn mathvariant="normal">4</mn></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007887&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007883&type= 11.34533310 3.80999994 ，迁徙次数 <math id="M70"><msub><mrow><mi>N</mi></mrow><mrow><mi mathvariant="normal">e</mi><mi mathvariant="normal">d</mi></mrow></msub><mo>=</mo><mn mathvariant="normal">2</mn></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007893&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007889&type= 11.59933376 3.80999994 ，迁徙概率 <math id="M71"><msub><mrow><mi>P</mi></mrow><mrow><mi mathvariant="normal">e</mi><mi mathvariant="normal">d</mi></mrow></msub><mo>=</mo><mn mathvariant="normal">0.25</mn></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007901&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007897&type= 16.00200081 3.72533321 。细菌每游动一步得到一组新的 <math id="M72"><msub><mrow><mi>k</mi></mrow><mrow><mi>p</mi></mrow></msub></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007909&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007905&type= 2.79399991 3.72533321 ， <math id="M73"><msub><mrow><mi>k</mi></mrow><mrow><mi>i</mi></mrow></msub></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007915&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007913&type= 2.45533323 3.72533321 ， <math id="M74"><msub><mrow><mi>k</mi></mrow><mrow><mi>d</mi></mrow></msub></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007922&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007918&type= 2.96333337 3.72533321 ，在适应度函数中代入新的细菌位置并运行仿真控制程序，得到控制误差，将整个控制过程的控制误差绝对值的和作为适应度值。 待算法运行结束，细菌完成觅食，输出最优的细菌位置，即最优的PID控制器参数，此时细菌最优状态为［8.423，5.042，9.489］。在仿真控制程序中，PID控制器采用最优的控制参数，运行程序，得到控制前后的振动响应如 图7 图7 所示。 从 图7 图7 可以看出，采用细菌觅食算法优化得到的PID控制器参数，进行振动控制仿真，控制效果明显。为了进一步体现细菌觅食算法优化PID控制器的优越性，选择经验法进行PID控制器参数整定与之对比。经验法整定PID控制器参数核心思想为：给控制系统施加一个单位阶跃信号作为输入，在给定控制器参数范围内反复调节参数大小，使最终系统响应为曲线的第一个波峰与第二个波峰比值为 <math id="M75"><mn mathvariant="normal">4</mn><mo>:</mo><mn mathvariant="normal">1</mn></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007942&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007938&type= 5.58799982 3.04800010 的理想曲线即可。与细菌觅食算法一致，经验法中控制器参数范围同样设定为 <math id="M76"><mn mathvariant="normal">0</mn><mo>≤</mo><msub><mrow><mi>k</mi></mrow><mrow><mi>p</mi></mrow></msub><mo>≤</mo><mn mathvariant="normal">10</mn></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007950&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007946&type= 17.94933319 4.23333359 ， <math id="M77"><mn mathvariant="normal">0</mn><mo>≤</mo><msub><mrow><mi>k</mi></mrow><mrow><mi>i</mi></mrow></msub><mo>≤</mo><mn mathvariant="normal">10</mn></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007961&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007954&type= 17.52599907 4.23333359 ， <math id="M78"><mn mathvariant="normal">0</mn><mo>≤</mo><msub><mrow><mi>k</mi></mrow><mrow><mi>d</mi></mrow></msub><mo>≤</mo><mn mathvariant="normal">10</mn></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007969&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007965&type= 18.11866570 4.23333359 ，通过反复调试，当PID控制器参数 <math id="M79"><msub><mrow><mi>k</mi></mrow><mrow><mi>p</mi></mrow></msub></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007975&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007973&type= 2.79399991 3.72533321 ， <math id="M80"><msub><mrow><mi>k</mi></mrow><mrow><mi>i</mi></mrow></msub></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007982&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007979&type= 2.45533323 3.72533321 ， <math id="M81"><msub><mrow><mi>k</mi></mrow><mrow><mi>d</mi></mrow></msub></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007990&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007986&type= 2.96333337 3.72533321 取值依次为5.4，1.2，9.2时，系统响应曲线如 图8 图8 所示，由图可知曲线前后两峰波峰值比为 <math id="M82"><mn mathvariant="normal">4.09</mn><mo>:</mo><mn mathvariant="normal">1</mn></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007996&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24007994&type= 10.32933331 3.04800010 ，系统对单位阶跃信号的响应近似理想曲线。将上述利用经验法整定的控制器参数代入仿真控制系统中，运行程序，得到控制前后效果如 图9 图9 所示。 综上，针对PID控制器参数整定，细菌觅食算法对比经验法：一方面，对比 图7 图7 和 图9 图9 可知，前者振动控制效果更好；另一方面，针对不同的PID控制系统，细菌觅食算法可进行算法移植，避免代码重复编写，而经验法还需重新反复调整参数以达到理想波形，前者优化过程更加智能、简便。 6 实验结果 1 6.1　标定实验与结果 2 相机标定即确定相机内外参数的过程，本文借鉴张正友提出的相机标定方法，选择MATLAB相机标定工具箱进行相机标定。利用3.2节得到的标定图像进行相机标定，标定结果如 表1 表1 所示。 f x f y u 0 v 0 k 1 k 2 2994.8 2994.2 295.04 228.85 -0.0154 0.4324 完成相机标定后，利用MATLAB软件编写线结构光平面标定程序，标定流程依次为获取相机标定结果、图像畸变校正、ROI提取、灰度重心法提取光条特征点、像素坐标转三维相机坐标及最小二乘法拟合光平面。 以其中一张光平面标定图像为例，如 图10 图10 所示，为其图像处理过程。从 图10 图10 （b）中可以看出，红色的拟合线段和激光条纹基本重合，说明灰度重心法提取光条特征点的精度较高。 经过光平面标定，得到激光平面方程为： <math display="block" id="M83"><mo>-</mo><mn mathvariant="normal">1.1857</mn><msub><mrow><mi>X</mi></mrow><mrow><mi>c</mi></mrow></msub><mo>+</mo><mn mathvariant="normal">49.2102</mn><msub><mrow><mi>Y</mi></mrow><mrow><mi>c</mi></mrow></msub><mo>-</mo><msub><mrow><mi>Z</mi></mrow><mrow><mi>c</mi></mrow></msub><mo>+</mo><mn mathvariant="normal">733.1001</mn><mo>=</mo><mn mathvariant="normal">0</mn></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24008046&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24008042&type= 71.96665955 3.80999994 . 联立 式（1） 式（1） 、 式（9） 式（9） ，并结合相机标定结果得到线结构光视觉测振系统数学模型为： <math display="block" id="M84"><mfenced open="{" close="" separators="|"><mrow><mtable columnalign="left"><mtr><mtd><mn mathvariant="normal">2</mn><mtext> </mtext><mn mathvariant="normal">994.8</mn><msub><mrow><mi>X</mi></mrow><mrow><mi>c</mi></mrow></msub><mo>+</mo><mo stretchy="false">(</mo><mn mathvariant="normal">295.04</mn><mo>-</mo><mi>u</mi><mo stretchy="false">)</mo><mi>Z</mi><mmultiscripts><mrow><mo>=</mo></mrow><mprescripts/><mrow><mi>c</mi></mrow><mrow/></mmultiscripts><mn mathvariant="normal">0</mn></mtd></mtr><mtr><mtd><mn mathvariant="normal">2</mn><mtext> </mtext><mn mathvariant="normal">994.2</mn><msub><mrow><mi>Y</mi></mrow><mrow><mi>c</mi></mrow></msub><mo>+</mo><mo stretchy="false">(</mo><mn mathvariant="normal">228.85</mn><mo>-</mo><mi>v</mi><mo stretchy="false">)</mo><mi>Z</mi><mmultiscripts><mrow><mo>=</mo></mrow><mprescripts/><mrow><mi>c</mi></mrow><mrow/></mmultiscripts><mn mathvariant="normal">0</mn></mtd></mtr><mtr><mtd><mo>-</mo><mn mathvariant="normal">1.185</mn><mtext> </mtext><mn mathvariant="normal">7</mn><msub><mrow><mi>X</mi></mrow><mrow><mi>c</mi></mrow></msub><mo>+</mo><mn mathvariant="normal">49.2102</mn><msub><mrow><mi>Y</mi></mrow><mrow><mi>c</mi></mrow></msub><mo>-</mo><msub><mrow><mi>Z</mi></mrow><mrow><mi>c</mi></mrow></msub><mo>+</mo><mn mathvariant="normal">733.1001</mn><mo>=</mo><mn mathvariant="normal">0</mn></mtd></mtr></mtable></mrow></mfenced></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24008054&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24008050&type= 74.67600250 15.15533447 . 由 式（10） 式（10） 可知，在线结构视觉系统数学模型中，若已知图像上某点的像素坐标，可求得该点在相机坐标系下的三维坐标值。 6.2　目标平面设计 2 整个测控系统均利用LabVIEW进行软件开发，图像处理部分用到的模块为NI Vision Assistant视觉助手。如 图11 图11 所示，为机械臂在转动过程中的一张振动图像及其对应的阈值分割效果图。可以看到，柔性臂在运动过程中，由于采集的振动图像背景变化太复杂，部分背景光强灰度值与目标激光条纹灰度值相差不大，阈值分割并不能将目标与背景进行有效分离，使得最终获取的质心与激光条纹中心相去甚远，不利于图像特征点的提取。 1;2; 为解决这一问题，选择建立参考坐标系，使测量目标的“ROI”跟随参考坐标系移动，以完成态特征的提取 ［ 15 15 ］ 。在视觉助手里设置图像处理程，具体实现过程依次为图像滤波、边缘检测、寻找直边、设置坐标系、阈值分割和质心获取。 边缘检测和寻找直边是为了确定参考坐标系的位置，而利用边缘检测选择参考点的过程，需要保证参考点在相机视野中一定存在且清晰易识别。为此，设计的目标平面如 图12 图12 所示，图中目标平面增设黑色矩形区域的作用是为了得到稳定的参考点，且保证黑色矩形左侧与激光条纹投影区域左侧基本处于同一条竖直线上。基于该目标平面，利用上文所述的方法对 图11 图11 （a）进行图像处理，得到图像处理结果如 图13 图13 所示，从 图13 图13 （b）可以看到图像感兴趣区域跟随参考坐标系移动，且最终获取的质心与激光条纹的中心一致。结果表明该图像处理方法对于图像背景变化复杂且背景对目标特征提取干扰较大时效果较好。 1;2; 6.3　测振实验与结果 2 利用LabVIEW进行图像采集程序设计，结合6.2节设计的图像处理程序，得到光条特征点像素坐标，再结合6.1节的测振系统数学模型，完成像素坐标到相机三维坐标的转换。运动前，采集柔性臂静止状态的图像并计算出三维坐标；运动过程中，采集柔性臂运动状态的图像并计算出三维坐标，将运动过程与静止状态的三维坐标做相应数学运算，便得到了柔性臂在运动过程中产生的振动位移信息。 为了验证上文设计的线结构光视觉测振系统的可行性和准确性，同时设计基于压电陶瓷的振动位移测量方法与之进行对比。压电陶瓷片的选型、粘贴位置及采集卡的选型与上文一致。按照步进电机角速度、电机细分及控制器脉冲频率三个参数分别设置4组实验 ［ 14 14 ］ ，具体参数如 表2 表2 所示。 2 实验组号 3 大电机 3 小电机 ω 1 n x 1 f q 1 ω 2 n x 2 f q 2 1 15 32 266 5 32 88 2 15 64 533 5 64 177 3 10 64 355 10 32 177 4 10 32 177 10 128 711 其中： <math id="M85"><msub><mrow><mi>ω</mi></mrow><mrow><mn mathvariant="normal">1</mn></mrow></msub></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24008131&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24008127&type= 3.64066648 3.72533321 ， <math id="M86"><msub><mrow><mi>ω</mi></mrow><mrow><mn mathvariant="normal">2</mn></mrow></msub></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24008138&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24008134&type= 3.64066648 3.72533321 分别为大、小电机的角速度，单位为（°）/s； <math id="M87"><msub><mrow><msub><mrow><mi>n</mi></mrow><mrow><mi>x</mi></mrow></msub></mrow><mrow><mn mathvariant="normal">1</mn></mrow></msub></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24008145&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24008142&type= 4.65666676 3.72533321 ， <math id="M88"><msub><mrow><msub><mrow><mi>n</mi></mrow><mrow><mi>x</mi></mrow></msub></mrow><mrow><mn mathvariant="normal">2</mn></mrow></msub></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24008153&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24008149&type= 4.65666676 3.72533321 分别为大、小电机的细分数； <math id="M89"><msub><mrow><msub><mrow><mi>f</mi></mrow><mrow><mi>q</mi></mrow></msub></mrow><mrow><mn mathvariant="normal">1</mn></mrow></msub></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24008158&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24008155&type= 3.80999994 4.57200003 ， <math id="M90"><msub><mrow><msub><mrow><mi>f</mi></mrow><mrow><mi>q</mi></mrow></msub></mrow><mrow><mn mathvariant="normal">2</mn></mrow></msub></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24008164&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24008161&type= 3.80999994 4.57200003 分别为大、小电机驱动脉冲速率，单位为pulse/s。 将柔性臂转动至刚性臂所在直线沿小电机方向的延长线上，作为起始位置；在测量程序中，视觉法测量时，帧速率选择90帧/s；压电法测量时，DAQ助手采样频率设置为90 Hz；设置完毕，同时启动大小步进电机，运行8 <math id="M91"><mtext> </mtext><mi mathvariant="normal">s</mi></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24008248&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24008246&type= 2.28600001 2.87866688 后，得到视觉及压电测量结果，如 图14 图14 所示。将上述结果进行傅里叶变换，得到对应频谱如 图15 图15 所示（考虑篇幅限制，仅展示第一组的结果）。 为更具体地对两者测量结果进行对比，定义两者测量差异： <math display="block" id="M92"><mi>E</mi><mo>=</mo><mfrac><mrow><mn mathvariant="normal">2</mn><mfenced open="|" close="" separators="|"><mrow><mfenced open="" close="|" separators="|"><mrow><msub><mrow><mi>A</mi></mrow><mrow><mi mathvariant="normal">y</mi></mrow></msub><mo>-</mo><msub><mrow><mi>A</mi></mrow><mrow><mi>s</mi></mrow></msub></mrow></mfenced></mrow></mfenced></mrow><mrow><msub><mrow><mi>A</mi></mrow><mrow><mi mathvariant="normal">y</mi></mrow></msub><mo>+</mo><msub><mrow><mi>A</mi></mrow><mrow><mi>s</mi></mrow></msub></mrow></mfrac></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24008195&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24008191&type= 26.07733345 10.83733368 ， 其中： <math id="M93"><msub><mrow><mi>A</mi></mrow><mrow><mi>y</mi></mrow></msub></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24008201&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24008198&type= 3.97933316 3.72533321 ， <math id="M94"><msub><mrow><mi>A</mi></mrow><mrow><mi>s</mi></mrow></msub></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24008207&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24008204&type= 3.72533321 3.72533321 分别表示压电法和视觉法对应频谱图中的峰值。根据 式（11） 式（11） 得到四组实验的测量结果差异分别为10.65%，7.38%，2.82%及9.72%，平均差异为7.64%。通过对比压电法和线结构光视觉法的时域和频域特性，在误差允许的范围内，两者测量结果一致。从而验证了线结构光视觉法测量振动信息的可行性和准确性。且线结构光视觉测振法无需改变被测物的结构特性，其测振精度取决于相机标定精度和线结构光平面标定精度。 6.4　控制实验与结果 2 整个控制程序由两部分组成：其一，获取柔性臂的实时振动位移量；其二，实现位移量到控制量的转换。程序的前半部分（获取振动位移信号）与振动测量程序相同，而柔性臂的实时振动位移量经由LabVIEW中的PID控制模块后可转换成控制量，再利用DAQ助手便可实现控制信号到USB-6003数据输出卡的传输。 与测振实验类似，控制实验同样选择4组，按照 表2 表2 设置电机参数，程序中相机帧速率选择90帧/ <math id="M95"><mi mathvariant="normal">s</mi></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24008220&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24008215&type= 1.52400005 2.79399991 ；DAQ助手设置成1采样；PID控制模块参数分别按照上文提出的两种方法（细菌觅食算法、经验法）优化得到的结果进行设置。设置完毕，运行控制程序，待出现位移信号，同时启动大、小步进电机，调节功率放大器，运行8 <math id="M96"><mi mathvariant="normal">s</mi></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24008220&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24008215&type= 1.52400005 2.79399991 ，分别记录控制后的振动位移信号。将位移信号进行傅里叶变换以便于进一步分析。 图16 图16 、 图17 图17 分别为控制前后时域及频谱对比（考虑篇幅问题，仅展示第1组的结果）。 为量化控制效果，将柔性臂控制前后的一阶频率响应幅值衰减率作为量化指标，得到四组实验的控制效果如 表3 表3 所示。 组别 经验法 智能法 第一组 28.69% 36.34% 第二组 27.32% 39.03% 第三组 15.44% 28.59% 第四组 31.14% 53.32% 平均值 25.65% 39.32% 综上，与仿真控制结果一致，智能法和经验法优化得到的控制器均能实现振动控制。从控制前后的振动位移图可知，控制作用主要集中在振动过程的中间阶段，约在振动产生1 <math id="M97"><mtext> </mtext><mi mathvariant="normal">s</mi></math> http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24008248&type= http://html.publish.founderss.cn/rc-pub/api/common/picture?pictureId=24008246&type= 2.28600001 2.87866688 后；而从 表3 表3 可以看到，无论是对比单组实验控制效果，还是整体平均控制效果，智能法较经验法的振动控制效果更好，进一步用实验验证了细菌觅食算法优化PID控制器参数的优越性。 7 结　论 1 首先将线结构光技术应用于柔性臂的振动测量，针对图像光条特征点提取受复杂背景干扰较大的情况，设计了合适的目标平面，提高了特征点提取精度；接着设计测振实验并与压电法对比验证了文中设计的线结构光视觉测振系统的可行性与准确性；最后利用细菌觅食算法优化PID控制器，并通过实验对控制算法进行了可行性验证。实验结果表明，针对柔性臂的一阶模态振动，利用经验法整定的PID控制方法平均控制效果为25.65%，而利用细菌觅食算法优化的PID控制方法平均控制效果为39.32%，验证了细菌觅食算法优化PID控制器参数的有效性。 参考文献 徐秀秀 ， 郭毓 ， 余臻 ， 等 . 基于机器视觉的柔性臂振动测量研究 ［J］. 华中科技大学学报（自然科学版） ， 2013 ， 41 （ S1 ）： 129 - 132 . doi: 10.47472/lyxe6926 http://dx.doi.org/10.47472/lyxe6926 基于机器视觉的柔性臂振动测量研究 XU X X ， GUO Y ， YU ZH ， et al . Vibration measurement of flexible beam based on machine vision ［J］. Journal of Huazhong University of Science and Technology （Natural Science Edition） ， 2013 ， 41 （ S1 ）： 129 - 132 . （in Chinese） . doi: 10.47472/lyxe6926 http://dx.doi.org/10.47472/lyxe6926 Vibration measurement of flexible beam based on machine vision 徐超 ， 张一凡 ， 韩晓明 ， 等 . 基于机器视觉的大柔性结构振动位移测量 ［J］. 振动 测试与诊断 ， 2017 ， 37 （ 4 ）： 781 - 786， 846 . doi: 10.16450/j.cnki.issn.1004-6801.2017.04.023 http://dx.doi.org/10.16450/j.cnki.issn.1004-6801.2017.04.023 基于机器视觉的大柔性结构振动位移测量 XU CH ， ZHANG Y F ， HAN X M ， et al . Machine vision based vibration displacement measurement of large flexible structures ［J］. Journal of Vibration ， Measurement & Diagnosis， 2017 ， 37 （ 4 ）： 781 - 786， 846 . （in Chinese） . doi: 10.16450/j.cnki.issn.1004-6801.2017.04.023 http://dx.doi.org/10.16450/j.cnki.issn.1004-6801.2017.04.023 Machine vision based vibration displacement measurement of large flexible structures 邱志成 ， 汪先锋 . 基于双目视觉的振动测量及控制 ［J］. 振动 测试与诊断 ， 2018 ， 38 （ 1 ）： 51 - 58， 205 . doi: 10.16450/j.cnki.issn.1004-6801.2018.01.008 http://dx.doi.org/10.16450/j.cnki.issn.1004-6801.2018.01.008 基于双目视觉的振动测量及控制 QIU ZH CH ， WANG X F . Vibration measurement and control based on binocular vision ［J］. Journal of Vibration ， Measurement & Diagnosis， 2018 ， 38 （ 1 ）： 51 - 58， 205 . （in Chinese） . doi: 10.16450/j.cnki.issn.1004-6801.2018.01.008 http://dx.doi.org/10.16450/j.cnki.issn.1004-6801.2018.01.008 Vibration measurement and control based on binocular vision 邱志成 ， 肖骏 . 线结构光视觉系统标定新法及其振动测控应用 ［J］. 光学精密工程 ， 2019 ， 27 （ 01 ）： 230 - 240 . doi: 10.3788/OPE.20192701.0230 http://dx.doi.org/10.3788/OPE.20192701.0230 线结构光视觉系统标定新法及其振动测控应用 QIU ZH CH ， XIAO J . New calibration method of line structured light vision system and application for vibration measurement and control ［J］. Optics and Precision Engineering ， 2019 ， 27 （ 01 ）： 230 - 240 . （in Chinese） . doi: 10.3788/OPE.20192701.0230 http://dx.doi.org/10.3788/OPE.20192701.0230 New calibration method of line structured light vision system and application for vibration measurement and control 彭聪 ， 缪卫东 ， 曾聪 . 基于机器视觉的轻型梁三维振动测量方法 ［J］. 北京航空航天大学学报 ， 2021 ， 47 （ 2 ）： 207 - 212 . doi: 10.3788/OPE.20192701.0230 http://dx.doi.org/10.3788/OPE.20192701.0230 基于机器视觉的轻型梁三维振动测量方法 PENG C ， MIAO W D ， ZENG C . Three-dimensional vibration measurement method for lightweight beam based on machine vision ［J］. Journal of Beijing University of Aeronautics and Astronautics ， 2021 ， 47 （ 2 ）： 207 - 212 . （in Chinese） . doi: 10.3788/OPE.20192701.0230 http://dx.doi.org/10.3788/OPE.20192701.0230 Three-dimensional vibration measurement method for lightweight beam based on machine vision 吴金华 . 基于PID算法的半导体温度控制系统的设计 ［J］. 机电技术 ， 2016 ， 39 （ 6 ）： 9 - 13 . doi: 10.1007/978-3-662-47926-1_7 http://dx.doi.org/10.1007/978-3-662-47926-1_7 基于PID算法的半导体温度控制系统的设计 WU J H . Design of semiconductor temperature control system based on PID algorithm ［J］. Mechanical & Electrical Technology ， 2016 ， 39 （ 6 ）： 9 - 13 . （in Chinese） . doi: 10.1007/978-3-662-47926-1_7 http://dx.doi.org/10.1007/978-3-662-47926-1_7 Design of semiconductor temperature control system based on PID algorithm 郭咏雪 ， 何立东 ， 王锎 . 基于磁流变阻尼器的双跨轴系PID振动控制研究 ［J］. 北京化工大学学报（自然科学版） ， 2018 ， 45 （ 3 ）： 67 - 71 . 基于磁流变阻尼器的双跨轴系PID振动控制研究 GUO Y X ， HE L D ， WANG K . PID vibration control in a two-span rotor system by means of magneto-rheological dampers ［J］. Journal of Beijing University of Chemical Technology （Natural Science Edition） ， 2018 ， 45 （ 3 ）： 67 - 71 . （in Chinese） PID vibration control in a two-span rotor system by means of magneto-rheological dampers 曹青松 ， 周继惠 ， 黎林 ， 等 . 基于模糊自整定PID算法的压电柔性机械臂振动控制研究 ［J］. 振动与冲击 ， 2010 ， 29 （ 12 ）： 181 - 186， 247 . doi: 10.3969/j.issn.1000-3835.2010.12.041 http://dx.doi.org/10.3969/j.issn.1000-3835.2010.12.041 基于模糊自整定PID算法的压电柔性机械臂振动控制研究 CAO Q S ， ZHOU J H ， LI L ， et al . Vibration control of piezoelectric flexible manipulator based on fuzzy self-tuning PID algorithm ［J］. Journal of Vibration and Shock ， 2010 ， 29 （ 12 ）： 181 - 186， 247 . （in Chinese） . doi: 10.3969/j.issn.1000-3835.2010.12.041 http://dx.doi.org/10.3969/j.issn.1000-3835.2010.12.041 Vibration control of piezoelectric flexible manipulator based on fuzzy self-tuning PID algorithm 张娟 ， 舒亚锋 ， 刘自强 ， 等 . 基于改进遗传算法的智能柔性机械臂压电片参数优化 ［J］. 应用力学学报 ， 2015 ， 32 （ 4 ）： 556 - 562，702 . doi: 10.1016/j.chinastron.2015.10.003 http://dx.doi.org/10.1016/j.chinastron.2015.10.003 基于改进遗传算法的智能柔性机械臂压电片参数优化 ZHANG J ， SHU Y F ， LIU Z Q ， et al . Optimization of position and piezoelectric parameter of smart flexible manipulator based on modified genetic algorithm ［J］. Chinese Journal of Applied Mechanics ， 2015 ， 32 （ 4 ）： 556 - 562， 702 . （in Chinese） . doi: 10.1016/j.chinastron.2015.10.003 http://dx.doi.org/10.1016/j.chinastron.2015.10.003 Optimization of position and piezoelectric parameter of smart flexible manipulator based on modified genetic algorithm ZHANG Z . A flexible new technique for camera calibration ［J］. IEEE Transactions on Pattern Analysis and Machine Intelligence ， 2000 ， 22 （ 11 ）： 1330 - 1334 . doi: 10.1109/34.888718 http://dx.doi.org/10.1109/34.888718 A flexible new technique for camera calibration 张瑞峰 ， 舒子芸 ， 南刚雷 . 一种新的线结构光标定方法 ［J］. 激光与光电子学进展 ， 2019 ， 56 （ 22 ）： 221101 . doi: 10.3788/lop56.221101 http://dx.doi.org/10.3788/lop56.221101 一种新的线结构光标定方法 ZHANG R F ， SHU Z Y ， NAN G L . Calibration method for line-structured light ［J］. Laser & Optoelectronics Progress ， 2019 ， 56 （ 22 ）： 221101 . （in Chinese） . doi: 10.3788/lop56.221101 http://dx.doi.org/10.3788/lop56.221101 Calibration method for line-structured light 刘金琨 . 先进PID控制MATLAB仿真 ［M］. 3版 . 北京 ： 电子工业出版社 ， 2011 . doi: 10.4028/www.scientific.net/amr.308-310.579 http://dx.doi.org/10.4028/www.scientific.net/amr.308-310.579 先进PID控制MATLAB仿真 LIU J K . Advanced PID control MATLAB simulation ［M］. 3rd edition . Beijing ： Publishing House of Electronics industry ， 2011 . （in Chinese） . doi: 10.4028/www.scientific.net/amr.308-310.579 http://dx.doi.org/10.4028/www.scientific.net/amr.308-310.579 Advanced PID control MATLAB simulation PASSINO K M . Biomimicry of bacterial foraging for distributed optimization and control ［J］. IEEE Control Systems Magazine ， 2002 ， 22 （ 3 ）： 52 - 67 . doi: 10.1109/mcs.2002.1004010 http://dx.doi.org/10.1109/mcs.2002.1004010 Biomimicry of bacterial foraging for distributed optimization and control 刘健 . 基于机器视觉的刚柔耦合机械臂振动控制研究 ［D］. 淮南 ： 安徽理工大学 ， 2019 . doi: 10.35940/ijrte.d6543.1110421 http://dx.doi.org/10.35940/ijrte.d6543.1110421 基于机器视觉的刚柔耦合机械臂振动控制研究 LIU J . Research on Vibration Control of Rigid-flexible Coupling Manipulator Based on Machine Vision ［D］. Huainan， China ： Anhui University of Science & Technology ， 2019 . （in Chinese） . doi: 10.35940/ijrte.d6543.1110421 http://dx.doi.org/10.35940/ijrte.d6543.1110421 Research on Vibration Control of Rigid-flexible Coupling Manipulator Based on Machine Vision 程光 . 机器视觉技术 ［M］. 北京 ： 机械工业出版社 ， 2019 . doi: 10.30919/esee8c795 http://dx.doi.org/10.30919/esee8c795 机器视觉技术 CHENG G . Machine Vision Technology ［M］. Beijing ： China Machine Press ， 2019 . （in Chinese） . doi: 10.30919/esee8c795 http://dx.doi.org/10.30919/esee8c795 Machine Vision Technology 10.37188/OPE.2021.0207 TP273 A 1004-924X（2021）11-2661-11 马天兵,宫晗,杜菲等.基于线结构光和优化PID的压电柔性机械臂振动控制[J].光学精密工程,2021,29(11):2661-2671. 马天兵,宫晗,杜菲等.基于线结构光和优化PID的压电柔性机械臂振动控制[J].光学精密工程,2021,29(11):2661-2671. MA Tian-bing,GONG Han,DU Fei,et al.Piezoelectric flexible manipulator vibration control based on line structured light and optimized PID[J].Optics and Precision Engineering,2021,29(11):2661-2671. MA Tian-bing,GONG Han,DU Fei,et al.Piezoelectric flexible manipulator vibration control based on line structured light and optimized PID[J].Optics and Precision Engineering,2021,29(11):2661-2671. 安徽高校自然科学研究项目（No.KJ2020A0281）；安徽省自然科学基金资助项目（No.2008085ME178）；安徽高校学科拔尖人才项目（No.gxbjZD202020063）；国家重点实验室项目（No.SKLMRDPC20ZZ01）；安徽高校协同创新项目（No.GXXT-2019-048）；安徽省重点研究与开发计划项目（No.202104a07020005） 2021-04-20 2021-06-30 2021-11-15 2022-01-25 光学精密工程 11 29