本发明涉及一种放餐装置及方法,具体涉及一种送餐机器人的自动放餐装置及控制系统。
背景技术:
目前,有很多企业机构已研发出用于餐厅智能送餐的机器人,但是只能实现替代餐厅服务员送餐这一自动送餐功能,在送餐机器人自动送餐到达顾客就餐位置之后仍需服务员手动将菜品放到餐桌上,这种送餐机器人只能部分替代服务员工作的现状并不能很好的提高餐厅运作效率以及降低人工成本,必定会影响到餐厅无人化智能化的普及。
技术实现要素:
本发明的目的在于解决现有的餐厅放餐没有实现无人化的问题,以提高餐厅运作效率和普及无人化、低人工成本的餐厅运作方式。
本发明为实现上述目的,采用以下技术方案实现:
1.一种送餐机器人的自动放餐装置,其特征在于基于送餐机器人的硬件平台,包括rgbd相机构成的深度视觉识别系统、以及机械臂和末端执行器构成的放餐执行机构,所述放餐执行机构具有两个:
(1)为了避免水雾及油雾的影响,所述rgbd相机采用防水结构,实时感知目标环境信息并回传给送餐机器人的中央处理单元。
(2)所述机械臂采用具有力矩传感器的电机驱动,具有多个自由度;所述末端执行器特征在于基于力反馈的欠驱动柔性自适应抓取。
2.一种送餐机器人的控制系统,采用所述的自动放餐装置,其特征包括采用rgbd相机构成的深度视觉识别系统获取桌面放餐区域的大小及空间坐标、规划机械臂与末端执行器的运动:
(1)所述深度视觉识别系统经过离线标定及双目校正后获取放餐区域的大小及空间坐标过程中,为了提高图像采集的真实度,采集到的图像信息先经过滤波除噪,图像增强预处理,之后经过边缘提取,图像匹配对餐桌放餐区域以及放餐区域周围环境进行分析;
(2)所述规划机械臂与末端执行器的运动,采用基于pid算法的反馈回路控制方法控制机械臂逼近目标放餐区域,采用非线性智能控制方法控制末端执行器实现灵活的放餐操作,以及为了确保放餐的平稳性,在放餐过程中采用自适应阻抗匹配。
3.进一步的,其特征在于以下实现步骤:
(1)所述送餐机器人到达顾客就餐位置,通过rgbd相机构成的深度视觉识别系统识别放餐区域位置并调整机器人位姿,确保目标放餐区域进入放餐执行机构的工作空间。
(2)所述送餐机器人利用rgbd相机构成的深度视觉识别系统采集目标放餐区域信息,包括放餐区域餐盘占用信息,放餐区域空间大小信息,放餐区域坐标信息。为了节省计算资源,建立合适的空间坐标系,计算放餐目标位置点的空间坐标,并实时微调送餐机器人位姿,使机器人的放餐执行机构能够以最优的方式放餐。
(3)根据所述送餐机器人获取的目标放餐区域的空间坐标、机器人自身机械臂以及末端执行器的相对位姿,在送到目标位置点的过程中,通过机器人的中央处理单元计算机器人末端执行器最优的餐盘抓取姿态以及机械臂的各个关节在连续时间内的旋转角度。
(4)所述送餐机器人机械臂移动到达目标放餐位置,通过控制基于力反馈的欠驱动柔性自适应的末端执行器实现放餐,放餐成功后将信息反馈给送餐机器人。
(5)根据步骤(2)、(3)、(4)、(5)相同原理,收回放餐执行机构到初始位姿,自动放餐过程结束,机器人自主移动离开当前餐桌,恢复待命状态。
4.进一步的,
在所述送餐机器人取餐后直至把餐盘送到目标放餐区域的过程中,通过rgbd相机构成的深度视觉识别系统实时反馈放餐执行机构的位姿,通过力矩传感器实时反馈力矩信息,机器人的中央处理单元实时优化最后运动路径,确保机器人的机械臂各关节的力矩在合适的范围内、确保机械臂各关节电机旋转角度最优、确保餐盘姿态稳定。
5.进一步的,
所述放餐执行机构具备自锁功能,当在放餐过程中所述送餐机器人出现故障时,放餐执行机构自锁,确保断电之后餐盘稳定不脱离末端执行器。
下面结合附图来进一步描述本专利的具体实施方案:
附图说明:
图1为自动放餐装置及控制系统框架图
图2为自动放餐流程图
图3为自动放餐场景示意图
图2中:1、机械臂;2、rgbd相机;3、送餐机器人;4、末端执行器;5、餐椅;6、放餐区域;7、餐桌。
1.一种送餐机器人的自动放餐装置,其特征在于基于送餐机器人3的硬件平台,包括rgbd相机2构成的深度视觉识别系统、以及机械臂1和末端执行器4构成的放餐执行机构,所述放餐执行机构具有两个:
(1)为了避免水雾及油雾的影响,所述rgbd相机2采用防水结构,实时感知目标环境信息并回传给送餐机器人3的中央处理单元。
(2)所述机械臂1采用具有力矩传感器的电机驱动,具有多个自由度;所述末端执行器4特征在于基于力反馈的欠驱动柔性自适应抓取。
2.一种送餐机器人的控制系统,采用所述的自动放餐装置,其特征包括采用rgbd相机2构成的深度视觉识别系统获取桌面放餐区域6的大小及空间坐标、规划机械臂1与末端执行器4的运动:
(1)所述深度视觉识别系统经过离线标定及双目校正后获取放餐区域6的大小及空间坐标过程中,为了提高图像采集的真实度,采集到的图像信息先经过滤波除噪,图像增强预处理,之后经过边缘提取,图像匹配对餐桌放餐区域6以及放餐区域周围环境进行分析;
(2)所述规划机械臂1与末端执行器4的运动,采用基于pid算法的反馈回路控制方法控制机械臂1逼近目标放餐区域6,采用非线性智能控制方法控制末端执行器4实现灵活的放餐操作,以及为了确保放餐的平稳性,在放餐过程中采用自适应阻抗匹配。
3.如图2所示,其特征在于以下实现步骤:
(1)所述送餐机器人3到达顾客就餐位置,通过rgbd相机2构成的深度视觉识别系统识别放餐区域6位置并调整机器人位姿,确保目标放餐区域6进入放餐执行机构1、4的工作空间。
(2)所述送餐机器人3利用rgbd相机2构成的深度视觉识别系统采集目标放餐区域6信息,包括放餐区域6餐盘占用信息,放餐区域6空间大小信息,放餐区域6坐标信息。为了节省计算资源,建立合适的空间坐标系,计算放餐目标位置点的空间坐标,并实时微调送餐机器人3位姿,使机器人的放餐执行机构1、4能够以最优的方式放餐。
(3)根据所述送餐机器人3获取的目标放餐区域6的空间坐标、机器人自身机械臂1以及末端执行器4的相对位姿,在送到目标位置点的过程中,通过机器人的中央处理单元计算机器人末端执行器4最优的餐盘抓取姿态以及机械臂1的各个关节在连续时间内的旋转角度。
(4)所述送餐机器人3机械臂1移动到达目标放餐位置,通过控制基于力反馈的欠驱动柔性自适应的末端执行器4实现放餐,放餐成功后将信息反馈给送餐机器人3。
(5)根据步骤(2)、(3)、(4)、(5)相同原理,收回放餐执行机构到初始位姿,自动放餐过程结束,机器人自主移动离开当前餐桌,恢复待命状态。
4.在所述送餐机器人3取餐后直至把餐盘送到目标放餐区域6的过程中,通过rgbd相机2构成的深度视觉识别系统实时反馈放餐执行机构1、4的位姿,通过力矩传感器实时反馈力矩信息,机器人的中央处理单元实时优化最后运动路径,确保机器人的机械臂1各关节的力矩在合适的范围内、确保机械臂1各关节电机旋转角度最优、确保餐盘姿态稳定。
5.所述放餐执行机构1、4具备自锁功能,当在放餐过程中所述送餐机器人3出现故障时,放餐执行机构自锁,确保断电之后餐盘稳定不脱离末端执行器4。