师云雷-许三多:
这个问题不算复杂,我建议你应该去搜下论文看看,我简单回答一下。
一般情况下6维力传感器安装在机器人末端,那么人手握持着力传感器去用力就能测量出来3个力和3个扭矩,对应机械臂笛卡尔末端的力和力矩即F=(FX,FY,FZ,TX,TY,TZ),用这个期望的F去做控制有几个思路:
-
用机械臂雅克比的转置右乘F就得到了关节的期望力矩,你可以把这个关节力矩作为控制力矩发出去,当然前馈力矩要加上(重力补偿,摩擦补偿,适当的阻尼等等);这种方法风险比较高安全性差了点,,但是非常符合物理直觉,如果各项参数精确,效果是最好的;
-
用机械臂雅克比的转置右乘F得到关节的期望力矩,得到关节力矩后不要直接用,乘以一个系数(变换)得到期望的关节角加速度,然后积分得到速度和位置,去做PID控制,比第一个好的是你可以自己限制一下加速度的量,安全一些,但是关节力矩映射到关节加速度最好是用惯量矩阵算一下,不算的话也可以直接当成E矩阵·····也能用,但是操作手感不会太轻盈;
-
用机械臂雅克比的转置右乘F得到关节的期望力矩,得到关节力矩后不要直接用,乘以一个系数(变换)得到期望的关节角速度,积分得到期望位置,然后去给各个关节做PID,这个方法更简单,甚至你可以去限制关节速度也会更安全;这个思路类似第二个,但是没有太明显的物理意义,毕竟直接关节力矩映射到关节速度不是很有物理道理,但是it works,手感也不太好.
桂凯:
1.拖动示教的实现原理有多种,楼上@师云雷-许三多 说的很详细,可以参考国内一篇文章《面向直接示教的机器人零力控制》。拖动示教关键在于建立机器人系统的动力学方程及系统辨识,当你这两部分弄得很清楚时,你会发现拖动示教只是一个小小的策略游戏而已;而这两部分弄不清楚,做拖动示教感觉就是花拳绣腿。
2.通过力传感器做拖动示教,只是理论上非常容易做,基本原理是阻抗/导纳控制,楼上的说的很详细。但实际应用中也有不少难点,特别是工业上:质量不好的力传感器零点容易漂,会有安全隐患;质量稍微好点的力传感器价格贵的要死,基本比机器人本上还贵。
所以工业中更倾向于只用电流环做拖动示教,而此时,就更需要对机器人动力学与系统辨识有较深的认识。
李淼robot:
谢邀。在工业上的做法很多取决于你能够控制机器人的哪一层了。基本的核心原理都是假想机器人末端是一个virtual dynamics。
但是要完全实现virtual dynamics,首先就需要对机器人本身的dynamics 完全的补偿掉,不是每一个机器人都能这么准确的去做这个的。目前市面上的就KUKA iiwa,LWR能够有这个效果。FRANKA据说有,但是一直没有面向市场,这种做法标定是个坑,不是那么容易。
如果不能完全实现virtual dynamics,退而求其次,我们在运动学层面,保证速度的一致性,但是这样会有一些阻力的感觉,因为加速度项毕竟没有考虑了。这些是工业上用的最多的,一个力传感器加上一个可以位置控制的机器人。直接用电流,有一定的安全风险,除非是机器人厂家许可,一般不建议这么做。
上面说的都是公式层面的东西,一行公式都解决了,实际中比这个要麻烦一点。力传感器本身噪音非常大,人的手还有一个20hz左右的抖动,这些都要靠滤波,滤波的参数也是需要一个个去调试的。
侯澈
把反馈的力乘个系数,计算结果下发给末端期望速度,完成。