针对空间遥操作任务设计一种新型的大行程力反馈手控器,该装置3个方向的运动相互解耦.对雅可比矩阵进行分析,该装置的速度传递和力传递具有各向同性.在此基础上提出一种基于接触力的速度控制方法.通过实时获取各轴的力传感器数据,得到操作者施加力的方向与大小.然后求解与期望力的差值,将其作为PID控制器的输入量.通过PID控制器控制电机速度,给出合适的控制量,驱动电机完成运动.制作实验样机进行测试,结果表明,上述方法能达到较好的控制效果.
A force feedback haptic device with a large workspace is developed for space teleoperation tasks, and the motion of the device in 3 directions is decoupled from each other. The velocity isotropic index and force isotropic index are analyzed through the Jacobin matrix. On this basis, a velocity control algorithm based on interaction force signal is proposed. Force signals for each axis are acquired in real time to estimate the magnitude and the direction of force exerted by the operator. And then the difference between the desired force and the acquired interaction force data is taken as the input of the PID (proportional-integral-derivative) controller. The PID control algorithm is used to control the motor speed. A proper data is given to control the motor to accomplish the movement. Experiments are conducted on a prototype mechanism. The results show that the proposed method can achieve better control results.