一种送餐机器人控制系统及其运动轨迹控制方法
【技术领域】
[0001]本发明属于自动化控制技术领域，具体讲就是涉及一种送餐机器人控制系统及其运动轨迹控制方法，提高了送餐机器人运行轨迹的精确性。
【背景技术】
[0002]随着科技和工业的发展，智能机器人由于其具有的巨大功能越来越得到广泛关注，智能机器人的使用行业从工业生产行业逐步发展到替代人们生活中的某些工作岗位，尤其在服务行业，家政服务机器人，餐厅送餐机器人等等受到广大消费者的欢迎，送餐机器人不仅是让就餐者体验先进的机器人技术，更重要的是增加机器人的智能性和实用性，从而代替服务员，解决餐饮行业服务员的缺口。
[0003]但是目前市场上在使用送餐机器人绝大多数都采用循迹控制模式，如山东大陆科技有限公司的专利号为201210180494.7公开的一种送餐机器人，包括可沿导轨运行的主体，主体包括头部组件、躯干部组件和机器人手臂，机器人手臂水平托举有餐盘，主体内设置有控制器以及与控制器连接的动力装置、驱动装置、行走装置、无线信号传输装置和语音装置，导轨为磁性导轨，主体上设置有循迹定位装置和避障装置;该种送餐机器人结构简单，不需要复杂的图像运算，节省电能，增加了运行时间。但是这种传统的送餐机器人只能沿着铺设的磁条或色带行走，不但会改变餐厅现有的装修风格，影响美观，也增加了安装成本。为了解决上述难题，市面上出现了不依赖固定导轨行走，能自主定位和导航的送餐机器人，其采用激光或视觉定位和导航，虽然可以克服上述缺点，但增加了成本，难于在餐饮行业推广。其它采用Zigbee定位技术、惯性定位技术等虽然具有成本低、安装方便等优点，但定位精度和稳定性较差，不能很好地满足送餐机器人定位精度高、稳定性好、成本低的要求。
【发明内容】
[0004]本发明的目的就是为了克服上述现有送餐机器人运动轨迹控制方法精度低，可靠性差，成本高的技术缺陷，提供一种送餐机器人控制系统及其运动轨迹控制方法，具有精度高、稳定性好、性价比高的优点。其不需要铺设导航轨道，可以实现按预设的路径自主行走，当餐厅布局改变时，该方法不要施工，只需要在软件中修改预设轨迹即可工作。
[0005]技术方案
[0006]为了实现上述技术目的，本发明设计一种送餐机器人控制系统，其特征在于:它包括控制板，所述控制板通过串口与带有里程计算功能的电机驱动器连接，电机驱动器能够驱动机器人的左轮电机和右轮电机，所述控制板连接有超宽带定位系统、姿态传感器和红外和超声波模块；
[0007]所述超宽带定位系统包括参考节点、机器人上的移动节点和定位引擎服务器，参考节点和机器人上的移动节点之间通过超宽带通信，服务器和机器人上的移动节点之间通过无线数传方式传输数据，服务器通过无线数传方式接收控制板传来的左右电机的里程信息。
[0008]所述控制板，机器人上的移动节点和姿态传感器，红外和超声波模块及电机驱动器通过电池模块供电。
[0009]上述送餐机器人控制系统的运动轨迹控制方法，其特征在于，它包括以下几个步骤:
[0010](I)根据餐厅布局确定各餐桌的位置坐标和送餐机器人行走轨迹的坐标区间；
[0011](2)机器人根据操作人员选定的目标桌位确定目的坐标，然后根据目的坐标选定行走路径；
[0012](3)从姿态传感器读取运动姿态信息，调整运动姿态后开始运动；
[0013](4)执行定位算法得到即时位置坐标，判断位置坐标是否在预定轨迹范围内，如果在预定的轨迹范围运行，则保持此姿态继续行走，如果超出预定的轨迹范围，则调整运行姿
??τ O
[0014]进一步，所述步骤(4)中调整运行姿态的具体方法是若向左超出预定轨迹，则左轮速度加大，若向右超出预测范围，则右轮速度加大；以偏离中心的位移量和当前的航向角为输入，以左右轮的速度差为输出，实现在线模糊控制。
[0015]进一步，所述步骤(4)中执行定位算法得到即时位置坐标的具体步骤是:
[0016](a)在取餐处对里程计定位位置进行初始化，消除在每一次送餐过程中的累计误差。
[0017](b)采用里程计定位算法得到即时送餐机器人的位置增量和位置坐标；
[0018](C)然后通过机器人运动速度和位移判断超宽带定位系统工作是否正常，若机器人速度大于零，且位移与上个控制周期相比发生变化，但超宽带定位系统返回到各参考节点的距离没变，则判断为超宽带定位工作不正常，则采用里程计得到的位置增量和上次位置信息为当前即时位置坐标;若超宽带信号工作正常，则采用超宽带定位的结果与里程计定位结果通过卡尔曼滤波算法进行融合得到当前即时位置坐标。
[0019]有益效果
[0020]本发明提供一种送餐机器人控制系统及其运动轨迹控制方法，具有精度高、稳定性好、性价比高的优点。其不需要铺设导航轨道，可以实现按预设的路径自主行走，当餐厅布局改变时，该方法不要施工，只需要在软件中修改预设轨迹即可工作。
【附图说明】
[0021]附图1是本发明中控制系统结构图。
[0022]附图2是本发明中运动轨迹控制控制流程图。
[0023]附图3是本发明中定位算法流程图。
附图4是本发明中定位曲线示意图。
【具体实施方式】
[0024]下面结合附图和实施例，对本发明做进一步说明。
[0025]实施例
[0026]如附图1所示，一种送餐机器人控制系统，它包括控制板I，所述控制板I通过串口与带有里程计算功能的电机驱动器2连接，电机驱动器2能够驱动机器人的左轮电机3和右轮电机4，所述控制板I连接有超宽带定位系统5、姿态传感器6和红外和超声波模块7;
[0027]所述超宽带定位系统5包括参考节点501、机器人上的移动节点502和定位引擎服务器503，参考节点501和机器人上的移动节点502之间通过超宽带通信，定位引擎服务器503和机器人上的移动节502点之间通过无线数传方式传输数据，定位引擎服务器503通过无线数传方式接收控制板I传来的左轮电机3和右轮电机4的里程信息。
[0028]所述控制板I，机器人上的移动节点502和姿态传感器6，红外和超声波模块7及电机驱动器2通过电池模块供电。
[0029]如附图2所示，送餐机器人控制系统的运动轨迹控制方法，其特征在于，它包括以下几个步骤:
[0030]第一步，根据餐厅布局确定各餐桌的位置坐标和送餐机器人行走轨迹的坐标区间；
[0031 ]第二步，机器人根据操作人员选定的目标桌位确定目的坐标，然后根据目的坐标选定行走路径；
[0032]第三步，从姿态传感器读取运动姿态信息，调整运动姿态后开始运动；
[0033]第四步，