基于模糊迭代算法的曲面恒力跟踪

doi:10.16183/j.cnki.jsjtu.2020.04.002

摘要/Abstract

摘要： 针对机器人末端执行器对曲面轮廓跟踪时难以得到恒定跟踪力的问题，对机器人末端执行器和曲面轮廓的接触力进行了研究，建立了研究对象曲面法向力和已知传感器坐标系的映射关系，提出了一种模糊迭代算法.模糊迭代算法不需要得到系统内部传递函数，简化了建模设计，同时，模糊迭代算法根据上次实验力误差以及误差变化量模糊补偿机器人的轨迹，加快了收敛速度，文中在理论上证明了模糊迭代算法有界收敛.实验结果显示: 接触力的波动范围在±3 N之内，验证了此算法的可行性，相比于传统的比例微分(PD)算法，接触力误差波动的均方差减少了42%；相比于未进行模糊补偿的算法，在所选择的时间段内迭代周期至少减了1次.

关键词: 机器人, 曲面跟踪, 恒力控制, 模糊算法, 迭代算法

Abstract: Aiming at the problem that it is difficult to obtain a constant tracking force when the robot end-effector tracks the contour of a curved-surface workpiece, the contact force between robot end-effector and the curved-surface workpiece is analyzed, the mapping relationship between the normal force of the curved surface and the known sensor coordinate system is established, and a fuzzy iterative algorithm is proposed. Iterative algorithm does not need to get the advantages of the system internal transfer function, which simplifies the modeling design. Meanwhile，the fuzzy iterative algorithm compensates the robot trajectory based on the previous experimental force error and the amount of error change, which accelerates the convergence speed. The bounded convergence of fuzzy iterative algorithm is proved theoretically. The experimental results show that the fluctuation range of contact force is within ±3 N, which verifies the feasibility of this algorithm. Compared with the traditional proportional-derivative (PD) algorithm, the standard deviation of contact force of the fuzzy iterative algorithm is reduced by 42%. Compared with the iterative algorithm without fuzzy compensation, the iteration cycle is reduced at least once in the selected time periods.

Key words: robot, curved-surface tracking, constant force control, fuzzy algorithm, iterative algorithm

中图分类号:

TP 242.2

张铁, 肖蒙, 邹焱飚, 肖佳栋. 基于模糊迭代算法的曲面恒力跟踪[J]. 上海交通大学学报, 2020, 54(4): 344-351.

ZHANG Tie, XIAO Meng, ZOU Yanbiao, XIAO Jiadong. Curved-Surface Constant Force Tracking Based on Fuzzy Iterative Method[J]. Journal of Shanghai Jiao Tong University, 2020, 54(4): 344-351.

参考文献

［1］WANG G, WANG Y, ZHANG L. Development and polishing process of a mobile robot finishing large mold surface［J］. Machining Science and Technology, 2014, 18(4): 603-625. ［2］杨林, 赵吉宾, 李论, 等. 有机玻璃研磨抛光机器人力控制研究［J］. 机械设计与制造, 2015, 290(4): 105-107. YANG Lin, ZHAO Jibin, LI Lun, et al. A study of grinding and polishing robot force control for plexiglass［J］. Machinery Design and Manufacture, 2015, 290(4): 105-107. ［3］韩瑜, 许燕玲, 花磊, 等. 六轴关节机器人系统结构及其关键技术［J］. 上海交通大学学报, 2016, 50(10): 1521-1525. HAN Yu, XU Yanling, HUA Lei, et al. Development and key technology of six axis joint robots［J］. Journal of Shanghai Jiao Tong University, 2016, 50(10): 1521-1525. ［4］陈玉山. 6R型工业机器人关节刚度辨识与实验研究［D］. 武汉: 华中科技大学, 2011. CHEN Yushan. Joint stiffness identification of 6R industrial robot and experimental verification［D］. Wuhan: Huazhong University of Science and Technology, 2011. ［5］吴得祖. 基于六维力传感器的机器人曲面跟踪力控制与实验研究［D］. 秦皇岛: 燕山大学, 2013. WU Dezu. Force control of the robot surface tracking and its experiment research based on six-axis force sensor［D］. Qinhuangdao: Yanshan University, 2013. ［6］ALEXANDER W, JOZEF S. Force controlled contour following on unknown objects with an industrial robot［C］//2013 IEEE International Symposium on Robotic and Sensors Environments (ROSE). Washington: IEEE, 2013: 208-213. ［7］YE B, SONG B, LI Z, et al. A study of force and position tracking control for robot contact with an arbitrarily inclined plane［J］. International Journal of Advanced Robotic Systems, 2013, 10(1): 69-75. ［8］SEUL J, HSIA T C. Robust neural force control scheme under uncertainties in robot dynamics and unknown environment［J］. IEEE Transactions on Industrial Electronics, 2002, 47(2): 403-412. ［9］WANG W, LEE C. Fuzzy neural network-based adaptive impedance force control design of robot manipulator under unknown environment［C］//IEEE International Conference on Fuzzy Systems. Beijing: IEEE, 2014: 1442-1448. ［10］王磊, 柳洪义. 面向未知环境基于智能预测的模糊控制器研究. 信息与控制［J］. 信息与控制, 2006, 35(1): 38-42. WANG Lei, LIU Hongyi. Fuzzy controller based on intelligent prediction in unknown environment［J］. Information and Control, 2006, 35(1): 38-42. ［11］丁希仑, 周乐来, 周军. 机器人的空间位姿误差分析方法［J］. 北京航空航天大学学报, 2009, 35(2): 241-245. DING Xilun, ZHOU Lelai, ZHOU Jun. Pose error analysis of robot in three dimension［J］. Journal of Beijing University of Aeronautics and Astronautics, 2009, 35(2): 241-245. ［12］李仁俊, 韩正之. 迭代学习控制综述［J］. 控制与决策, 2005, 20(9): 961-966. LI Renjun, HANG Zhengzhi. Survey of iterative learning control［J］. Control and Decision, 2005, 20(9): 961-966. ［13］张航, 罗大庸, 黄浩江, 等. 机器人模糊迭代学习控制及其仿真研究［J］. 自动化技术与应用, 2002, 38(2): 6-8. ZHANG Hang, LUO Dayong, HUANG Haojiang, et al. Fuzzy iterative learning control of robot and its simulation［J］. Techniques of Automation and Applications, 2002, 38(2): 6-8. ［14］刘金琨. 机器人控制系统的设计与MATLAB仿真［M］. 北京: 清华大学出版社, 2008: 262. LIU Jinkun. Robot control system desiging and MATLAB simulation［M］. Beijing: Tsinghua University Press, 2008: 262. ［15］CALANCA A, MURADORE R, FIORINI P. A review of algorithms for compliant control of stiff and fixed-compliance robots［J］. IEEE/ASME Transactions on Mechatronics, 2016, 21(2): 613-624. ［16］UCHIYAMA M. Formation of high-speed motion pattern of a mechanical arm by trial［J］. Transactions of the Society of Instrumentation and Control Engineers, 1979, 14(6): 706-712. ［17］刘金琨. 智能控制技术［M］. 3版. 北京: 北京航空航天大学出版社, 2014. LIU Jinkun. Intelligent control［M］. 3rd ed. Beijing: Beijing University of Aeronautics and Astronautics Press, 2014. ［18］胡广. 用于磨削加工的机器人力控制方法研究［D］. 广州: 华南理工大学, 2016. HU Guang. Research on robot force control method used on grinding process［D］. Guangzhou: South China University of Technology, 2016.

[1]	李锦江, 向先波, 刘传, 杨少龙. 基于预设性能制导律的欠驱动AUV海底地形鲁棒时滞跟踪控制[J]. 上海交通大学学报, 2022, 56(7): 944-952.
[2]	姜俊豪, 陈刚. 驾驶机器人转向操纵的动态模型预测控制方法[J]. 上海交通大学学报, 2022, 56(5): 594-603.
[3]	郭加伟, 许志杰, 何其昌. 虚拟装配手势库设计及人机工效评估优化[J]. 上海交通大学学报, 2022, 56(2): 127-133.
[4]	乐健, 刘一春, 张华, 陈小奇. 基于失真信号滤波算法的送丝速度检测方法[J]. 上海交通大学学报, 2022, 56(10): 1334-1340.
[5]	王宇轩, 刘朝雨, 王江北, 费燕琼. 具有多地形运动能力的双模块软体机器人[J]. 上海交通大学学报, 2022, 56(10): 1388-1396.
[6]	丁显廷. 单细胞生命体的系统工作原理是什么？[J]. 上海交通大学学报, 2021, 55(Sup.1): 14-15.
[7]	李翠明, 王宁, 张晨. 基于改进遗传算法的光伏板清洁分级任务规划[J]. 上海交通大学学报, 2021, 55(9): 1169-1174.
[8]	吴利红, 封锡盛, 叶作霖, 李一平. 自主水下机器人强制自航下潜的类物理模拟[J]. 上海交通大学学报, 2021, 55(3): 290-296.
[9]	刘佳鹏, 王江北, 丁烨, 费燕琼. 晶格型模块化软体机器人自重构序列[J]. 上海交通大学学报, 2021, 55(2): 111-116.
[10]	张力文, 徐齐平, 刘锦阳. 软体尺蠖爬行机器人建模与仿真分析[J]. 上海交通大学学报, 2021, 55(2): 149-160.
[11]	齐东润, 陈刚. 无人驾驶机器人多目标模糊操纵策略[J]. 上海交通大学学报, 2021, 55(10): 1310-1319.
[12]	薛蓉蓉, 王志武, 颜国正, 庄浩宇. 肠道机器人获取的肠道图像降噪处理方法[J]. 上海交通大学学报, 2021, 55(10): 1303-1309.
[13]	刘文海，胡洁，王伟明. 基于完备抓取构型和多阶段网络的软体手抓取[J]. 上海交通大学学报, 2020, 54(5): 507-514.
[14]	张铁，吴圣和，蔡超. 基于浮动平台的机器人恒力控制研磨方法[J]. 上海交通大学学报, 2020, 54(5): 515-523.
[15]	李岳明，王小平，张军军，曹建，张英浩. 基于改进二次规划算法的X舵智能水下机器人控制分配[J]. 上海交通大学学报, 2020, 54(5): 524-531.