发明名称 | 基于触觉传感器的遥操作机器人力觉临场感控制方法 | ||
摘要 | 一种基于触觉传感器的遥操作机器人力觉临场感控制方法,包括:主边回路和从边回路,主边回路由主边回路开关、主边控制器、主机器人和比较器构成,从边回路由从边控制器、从机器人和比较器构成,步骤如下:将位置差信号xu发送给从边控制器,从边控制器形成的输出控制量us,us进入输出给从机器人并用于控制从机器人运动,在从机器人上设置触觉传感器用于感知环境对从机器人作用力fe,当fe大于阈值fT时,接通主边回路中的主边回路开关,xu被输入至主边控制器,输出控制量为um,最后,将um输出至主机器人并由主机器人产生作用于操纵者的反馈力,使操作者产生力觉临场感,同时从机器人跟随主机器人运动;当反馈力信号fe小于fT时,主机器人不提供反馈力给操作者。 | ||
申请公布号 | CN101887264B | 申请公布日期 | 2012.02.01 |
申请号 | CN201010218605.X | 申请日期 | 2010.06.30 |
申请人 | 东南大学 | 发明人 | 宋爱国;李新;吴涓;崔建伟 |
分类号 | G05B19/418(2006.01)I | 主分类号 | G05B19/418(2006.01)I |
代理机构 | 南京经纬专利商标代理有限公司 32200 | 代理人 | 黄雪兰 |
主权项 | 1.一种基于触觉传感器的遥操作机器人力觉临场感控制方法,其特征在于,所述遥操作机器人力觉临场感控制方法包括:主边回路(1)和从边回路(2),主边回路(1)由主边回路开关(13)、主边控制器(14)、主机器人(12)和比较器构成,从边回路(2)由从边控制器(21)、从机器人(22)和比较器构成,具体操作步骤如下:将位置差信号x<sub>u</sub>发送给从边控制器,从边控制器采用比例积分控制器且从边控制器形成的输出控制量u<sub>s</sub>为<img file="FSB00000647670600011.GIF" wi="620" he="76" />其中B<sub>s</sub>为从边控制器的积分系数,K<sub>s</sub>为从边控制器的比例系数,t为时间量,从边控制器将所述输出控制量u<sub>s</sub>输出给从机器人并用于控制从机器人运动,在从机器人上设置触觉传感器(24)且所述触觉传感器用于感知环境对从机器人的作用力f<sub>e</sub>,当f<sub>e</sub>大于阈值f<sub>T</sub>时,接通主边回路中的主边回路开关,所述位置差信号x<sub>u</sub>被输入至主边控制器并由主边控制器将位置差信号x<sub>u</sub>转化为主边控制器的输出控制量u<sub>m</sub>为<img file="FSB00000647670600012.GIF" wi="645" he="72" />其中B<sub>m</sub>为主边控制器的积分系数,K<sub>m</sub>为主边控制器的比例系数,t为时间量,最后,将主边控制器的输出控制量u<sub>m</sub>输出至主机器人并由主机器人产生作用于操纵者的反馈力,使操作者产生力觉临场感,同时从机器人跟随主机器人运动;当所述作用力f<sub>e</sub>小于阈值f<sub>T</sub>时,主机器人不提供反馈力给操作者,只有从机器人跟随主机器人运动,所述位置差信号x<sub>u</sub>由主边位置信号x<sub>m</sub>与从机器人反馈的从边位置信号x<sub>s</sub>之差构成,即,位置差信号x<sub>u</sub>=x<sub>m</sub>-x<sub>s</sub>。 | ||
地址 | 210096 江苏省南京市四牌楼2号 |