[发明专利]用于悬挂式机器人的导航定位辅助系统及导航定位方法

权利要求书

1.一种用于悬挂式机器人的导航定位辅助系统，其特征在于，包括：

轨道，机器人沿所述轨道在第一方向或第二方向上可滑动，所述轨道的靠近两端的位置处分别设有限位标识；

多个磁铁标识，多个所述磁铁标识在所述轨道的延伸方向上间隔开布置；

多个轨道支架，每个所述轨道支架的一端分别与所述轨道连接；

多个RFID标签，所述RFID标签设在所述轨道支架上，且每个所述RFID标签与一个所述磁铁标识相对应；

伺服运动模块，所述伺服运动模块设在所述机器人中，以驱动所述伺服运动模块在所述轨道上滑动；

控制模块，所述控制模块用于控制所述伺服运动模块在所述轨道上可滑动，所述控制模块设在所述机器人中；

传感器模块，所述传感器模块设在所述机器人中，所述传感器模块用于收集所述RFID标签、所述磁铁标识和所述限位标识的信息，并根据收集的信息重新计算确定或校准所述机器人在所述轨道上的绝对位置。

2.根据权利要求1所述的用于悬挂式机器人的导航定位辅助系统，其特征在于，所述限位标识为两个磁铁，两个所述磁铁间隔开布置在所述轨道的靠近端部的位置处。

3.根据权利要求2所述的用于悬挂式机器人的导航定位辅助系统，其特征在于，每个所述限位标识中的两个所述磁铁的间距为10-30cm。

4.根据权利要求1所述的用于悬挂式机器人的导航定位辅助系统，其特征在于，所述传感器模块包括：读卡器和霍尔传感器，所述读卡器和所述霍尔传感器间隔开设在所述机器人中，所述读卡器用于读取所述RFID标识的信息，所述霍尔传感器用于读取所述磁铁标识和所述限位标识的信息。

5.一种用于悬挂式机器人的导航定位方法，应用于权利要求1-4中任一项所述的用于悬挂式机器人的导航定位辅助系统，其特征在于，所述导航定位方法包括以下步骤：

接收轨道信息收集命令；

驱动机器人在轨道上沿第一方向或第二方向滑动；

收集RFID标签、磁铁标识和限位标识的信息，并根据伺服运动模块获取的里程值，重新计算确定或校准所述机器人在所述轨道上的绝对位置。

6.根据权利要求5所述的用于悬挂式机器人的导航定位方法，其特征在于，所述的收集RFID标签、磁铁标识和限位标识的信息的步骤包括：

检测到所述磁铁标识时，记录所述磁铁标识的信息m(x,y)；其中，x为所述磁铁标识的标识号，y为所述磁铁标识对应的当前从所述伺服运动模块获取到的里程值，记为里程值s；

检测到所述限位标识时，记录所述限位标识的信息M(x,y)，并切换所述机器人的滑动方向；其中，x为所述限位标识的标识号，y为所述限位标识对应的当前从所述伺服运动模块获取到的里程值，记为里程值s；

检测到所述RFID标签时，记录所述RFID标签的信息r(IDx,y),其中，IDx为从所述RFID标签中读取到的识别信息，记为ID，y为读取到所述RFID标签时的里程值。

7.根据权利要求6所述的用于悬挂式机器人的导航定位方法，其特征在于，将r(IDx,y)和m(x,y)的里程值相比较，若|r(y)-m(y)|D，D为RFID感应范围，则所述RFID标签与所述磁铁标识为相对应的一对，记为rm(IDx,x,y)，且在所述机器人沿所述第一方向和所述第二方向运动过程中均检测到所述限位标识时，所述机器人停止运动。

8.根据权利要求7所述的用于悬挂式机器人的导航定位方法，其特征在于，所述的重新计算确定或校准所述机器人在所述轨道上的绝对位置的步骤包括：

将记录到的M(x,y)按标识号进行排序，并用最大标识号对应的里程值减去最小标识号对应的里程值，获得所述轨道的长度信息，记为GLen；

将rm(IDx,x,y)的各个标识信息中的里程值与最小标识号对应的里程值相减，然后更新rm(IDx,x,y)中各个标识的里程值，得到所述机器人在所述轨道上的绝对位置；其中，rm(IDx,x,y)中，IDx为从所述RFID标签中读取到的识别信息，x为所述限位标识的标识号，y为磁铁标识的绝对位置。