简介:
本发明提供了一种多功能智能跟随小车系统,根据激光雷达发送的距离信息,得到智能跟随小车本体当前时刻在全局坐标系下的位置;在UWB正常跟踪时,将UWB基站发送的相对位姿信息与激光雷达发送的障碍物距离信息进行融合处理,采用局部建图行人跟踪定位算法,获取被跟随人在全局坐标系下的位姿信息;在UWB短时失效后,采用失效预测算法,预测被跟随人在全局坐标系下的位姿信息;将智能跟随小车本体当前时刻在全局坐标系下的位置作为起点,被跟随人在全局坐标系下的位置信息作为终点,生成运动控制指令,控制所述智能跟随小车本体运动。
本发明提供了一种多功能智能跟随小车系统,根据激光雷达发送的距离信息,得到智能跟随小车本体当前时刻在全局坐标系下的位置;在UWB正常跟踪时,将UWB基站发送的相对位姿信息与激光雷达发送的障碍物距离信息进行融合处理,采用局部建图行人跟踪定位算法,获取被跟随人在全局坐标系下的位姿信息;在UWB短时失效后,采用失效预测算法,预测被跟随人在全局坐标系下的位姿信息;将智能跟随小车本体当前时刻在全局坐标系下的位置作为起点,被跟随人在全局坐标系下的位置信息作为终点,生成运动控制指令,控制所述智能跟随小车本体运动。