一种六自由度咀嚼机器人的控制系统
摘要:
一种六自由度咀嚼机器人的控制系统,所要解决的问题为,传统的点到点的3次多项式插值所需力矩大,所需设备体积较大的问题。由于机器人机械加工精度的因素,每个咀嚼机器人都存在个体差异和六个驱动杆对称性,很难得到一致的PID控制参数的问题。其采用以下方案:步骤1:规划咀嚼机器人的各分支杆的运动轨迹,通过切牙点的位置和位姿求出各驱动杆的伸缩,过路径点的3次多项式插值方法求出各驱动杆期望位置和速度;步骤2:根据各分支杆的运动轨迹对机器人的咀嚼过程进行控制,咀嚼过程包括张开、闭合、咬合三个阶段;在张开和闭合两个阶段,使用模糊控制,咬合阶段采用模糊PID控制。
公开/授权文献
0/0