农业工程学报
農業工程學報
농업공정학보
2015年
1期
58-63
,共6页
王学林%肖永飞%毕淑慧%范新建%饶洪辉
王學林%肖永飛%畢淑慧%範新建%饒洪輝
왕학림%초영비%필숙혜%범신건%요홍휘
机器人%末端执行器%算法%柔性抓取%力控制%阻抗控制%采摘%导纳控制
機器人%末耑執行器%算法%柔性抓取%力控製%阻抗控製%採摘%導納控製
궤기인%말단집행기%산법%유성조취%력공제%조항공제%채적%도납공제
robots%end effectors%algorithms%flexible grasping%force control%impedance control%picking%admittance control
为减小机器人在采摘过程中对果蔬的损伤,设计了机器人柔性抓取试验平台,提出了一种适合末端执行器双指抓取果蔬的抓持力跟踪阻抗控制算法,该算法将末端执行器抓持果蔬系统等效为阻抗-导纳模型,使手指力/位控制等效为期望的惯量-阻尼-刚度模型,可按需调节其参数实现抓持力与位置的动态关系。期望抓持力与采集果蔬实际接触力的偏差作为外环力阻抗控制器的输入,控制器生成对内部位置环参考轨迹的校正量。该算法仅考虑沿末端执行器双指夹持果蔬方向,避免了使用多自由度机械臂阻抗控制算法的复杂性,提高了控制的实时性,同时对抓取系统模型的不确定和力扰动具有较强的鲁棒性。机器人抓取试验证明了双指抓持力反馈阻抗柔顺控制算法的有效性,可实现机器人柔性抓取,减小抓取果蔬损伤和保证品质。该研究可为农业机器人无损抓取和采摘提供关键技术。
為減小機器人在採摘過程中對果蔬的損傷,設計瞭機器人柔性抓取試驗平檯,提齣瞭一種適閤末耑執行器雙指抓取果蔬的抓持力跟蹤阻抗控製算法,該算法將末耑執行器抓持果蔬繫統等效為阻抗-導納模型,使手指力/位控製等效為期望的慣量-阻尼-剛度模型,可按需調節其參數實現抓持力與位置的動態關繫。期望抓持力與採集果蔬實際接觸力的偏差作為外環力阻抗控製器的輸入,控製器生成對內部位置環參攷軌跡的校正量。該算法僅攷慮沿末耑執行器雙指夾持果蔬方嚮,避免瞭使用多自由度機械臂阻抗控製算法的複雜性,提高瞭控製的實時性,同時對抓取繫統模型的不確定和力擾動具有較彊的魯棒性。機器人抓取試驗證明瞭雙指抓持力反饋阻抗柔順控製算法的有效性,可實現機器人柔性抓取,減小抓取果蔬損傷和保證品質。該研究可為農業機器人無損抓取和採摘提供關鍵技術。
위감소궤기인재채적과정중대과소적손상,설계료궤기인유성조취시험평태,제출료일충괄합말단집행기쌍지조취과소적조지력근종조항공제산법,해산법장말단집행기조지과소계통등효위조항-도납모형,사수지력/위공제등효위기망적관량-조니-강도모형,가안수조절기삼수실현조지력여위치적동태관계。기망조지력여채집과소실제접촉력적편차작위외배력조항공제기적수입,공제기생성대내부위치배삼고궤적적교정량。해산법부고필연말단집행기쌍지협지과소방향,피면료사용다자유도궤계비조항공제산법적복잡성,제고료공제적실시성,동시대조취계통모형적불학정화력우동구유교강적로봉성。궤기인조취시험증명료쌍지조지력반궤조항유순공제산법적유효성,가실현궤기인유성조취,감소조취과소손상화보증품질。해연구가위농업궤기인무손조취화채적제공관건기술。
One of the major challenges of agricultural robots is the grasping and picking fresh fruit and vegetable without any damage under the complex environment. In order to minimize the harm due to robot grasp, this paper mainly introduces a dexterous multisensory gripper design and also develops a new force impedance control algorithm. First, the gripper with dual motor drive was designed, and each of fingers had an independent servo drive system and was integrated with force and tactile sensors. The calibration force sensors were mounted at the root of each finger, and the force signals were obtained by the force sensors. The expected force, position and speed parameters of the fingers can be set separately, so the grip centre and stroke can be controlled for the finger by pre-programming, the movement and forces of grasped objects can be actively controlled to achieve through the two-finger operations. The gripper with both the mechanical mechanism and control flexibility was mounted in the end of the industrial robot. The grasping experiment platform composed of industrial robot and dexterous gripper integrated monocular vision, force sensing and many kinds of sensors. The 2-D vision was able to quickly detect and locate grasped objects at the top of the experiment platform. Second, a force impedance control algorithm was proposed and used for one of fingers, position control was used for another finger, and it can regulate the grasping force by defining the target impedance between desired position and contact force. The whole grasping system can be equivalent to impedance&admittance model, and the finger force/position control can be equivalent to the expected target inertia-damping-stiffness model, and the model parameters can be adjustable according to the needs to realize the dynamic relationship between grasping force and position. The contact force errors between expected force value and actual force acquired from the force sensor were as the input of impedance controller and its output can be realized by the reference trajectory correction to the internal position control loop. The proposed algorithm only considered the direction of gripping fruit and vegetable, and the reference trajectory can be determined simply, and then avoids the use of complicated impedance control for multi-degree of freedom manipulators, through which it can improve the real-time control and robustness of the grasping system with model uncertainty or external force disturbance. Robot grasping experiments show that the system runs smoothly and reliably, the force-feedback impedance control is very effective, and the steady state error is maximum range within ± 0.4N in the experiment of grasping the tomatoes and eggs. It can make force track value with small force overshot and fast response simultaneously between the end-effector and fruit and vegetable, so it makes the force controller adaptive to the dynamic grasp process between the end-effector and fruit and vegetable, it can realize the flexible grasping and reduce damages and ensure the quality of the grasped fruit and vegetable. The research provides a key control technology for the compliant grasping of fruit and vegetable.