基于Leap Motion和S曲线的飞行机器人机械臂控制研究

Control method study for robotic arm of aerial manipulator system based on Leap Motion and S curve

针对带有多自由度机械臂的飞行机器人,提出基于Leap Motion的控制方法以实现机械臂跟随人体手掌位置姿态运动的功能。采用DH方法建立了机械臂数学模型,给出了将Leap Motion获取的人手运动映射到机械臂末端的推导过程。利用7段S型曲线调速方法近似实现舵机角加速度连续没有突变,减轻了舵机快速响应给飞行器带来的冲击问题。设计制作了实物样机对控制方法的可实现性进行验证测试,在飞行测试中成功地利用Leap Motion控制远端的机械臂抓取到地面目标。

Setting the multi degree-of-freedom robotic arm of aerial manipulator systems as study object,this paper proposed a new approach based on Leap Motion through which robotic arm could follow the movement of human hand.It used DH method to build mathematical model of the robotic arm and presented derivation process of mapping human hand movement captured by Leap Motion to the end of robotic arm.To avoid abrupt change of servo’s angular acceleration and ease the impact on the aircraft,it adopted 7-sections S curve method to adjust the servo speed.This paper designed and fabricated a prototype machine to test realizability of the control method,and during flight test,the method successfully control the robotic arm to pick up an object in the distance by using Leap Motion.