[发明专利]一种基于全自动换电机器人的汽车电池坐标标定方法

说明书

技术领域

本发明涉及一种基于全自动换电机器人的汽车电池坐标标定方法。

背景技术

全自动换电机器人基本结构包括机器人的硬件结构、充当机器人眼睛的视觉系统、对机器人机械手进行控制的PLC控制系统，还包括协调视觉系统及PLC控制系统的主控中心，其中视觉系统包括设置在电动汽车上方用于获取电动汽车图像的顶部照相机、用于获取电动汽车内待换电池图像的侧部照相机，侧部相机是安装在机械手上的。

全自动换电机器人是电动汽车充换电站的核心技术，能够实现将电动汽车内耗尽的电池组准确取出来放入空电池箱，用电池箱内已充满电的电池组替代，那么汽车电池在机器人坐标系下位置坐标的准确性，决定了换电机器人是否能够成功换电。

在以往的机器人换电过程中，通过视觉系统对汽车内的电池进行拍照所获得电池的位置与电池的实际位置通常会出现偏差，因此如果能够事先知道通过拍照所确定的电池的取放电位置与电池的实际取放电位置之间的差值，在通过偏差实现电池位置的自动标定，将会对机器人的换电有重要指导意义。

与该申请相关的申请有申请号为2013106288395，名称为基于PLC控制的电动汽车自动换电池机构的换电池方法，申请号为201310629488X，名称为一种电动汽车全自动换电池控制系统及方法，申请号为2013106376358，名称为一种电动汽车全自动换电池系统，201320783049X一种电动汽车自动换电池机构的视觉定位系统。

发明内容

为了获取精确的汽车电池坐标，本发明提供一种基于全自动换电机器人的汽车电池坐标标定方法。

本发明的技术解决方案如下：

一种基于全自动换电机器人的汽车电池坐标标定方法，其特殊之处在于：包括以下步骤：

1】确定侧部相机的初步拍照位置

1.1】汽车停车后，调试控制中心发送指令至视觉系统，通过顶部相机对汽车顶部区域进行拍照，视觉系统得出汽车的停车位置，然后将该停车位置与固定停车位置作比较得出水平偏移值，反馈至调试控制中心；

根据汽车中电池组的安装高度确定侧部相机的拍照高度，反馈至调试控制中心；

1.2】针对电池组中的任一电池，调试控制中心根据电池组中电池排布位置以及所述水平偏移值和确定的侧部相机的拍照高度计算机械手的待机位（X待、Y待、Z待、θ待），即侧部相机的初步拍照位置，其中X待、Y待、Z待为计算的待机位坐标，θ待为机械手能够取到电池的偏转角度，只要汽车的停车位置不变，机械手的偏转角度θ待保持不变；

并将此待机位信息发送至PLC控制系统；

1.3】PLC控制系统控制机械手移动至侧部相机的初步拍照位置；

2】确定机械手的待机位坐标

测量侧部相机与该电池之间的垂直距离；反馈至调试控制中心；如果所测的垂直距离与侧部相机的拍照距离不相等，对机械手进行调整，使安装在机械手上的侧部相机与电池之间的垂直距离与侧部相机的拍照距离相等，拍照距离记为S，并将拍照距离S与实际测量距离的差值反馈至调试控制中心，

3】确定电池取电坐标偏差

3.1】侧部相机对换电汽车中的电池进行拍照，调试控制中心计算得到该电池的三维取电坐标（X取、Y取、Z取），即电池的计算取电坐标，

3.2】断开调试控制中心与PLC控制系统之间的连接，调整机械手使机械手能够取出电池组中的电池，记录机械手此时的坐标（X′取、Y′取、Z′取），即该电池的实际取电坐标，

将该电池的实际取电坐标录入调试控制中心，调试控制中心计算该电池实际取电坐标与计算取电坐标的偏差，从而完成该电池取电坐标偏差的标定；

4】确定电池放电偏差

在实际取电坐标（X′取、Y′取、Z′取）的基础上，再次调整机械手，使机械手将取出的电池能够放进电池仓，记录机械手将电池放进电池仓时机械手的坐标（X′放、Y′放、Z′放），即该电池的实际放电坐标，将该电池的实际放电坐标录入调试控制中心，调试控制中心计算该电池的实际放电坐标与该电池的实际取电坐标的偏差，从而完成该电池放电偏差的标定；

5】调试控制中心将标定的各偏差值生成参数配置文件。

对相对于机械手成1行分布的四节电池进行标定时，按照电池的排列顺序依次将该四节电池分别命名为1号电池、2号电池、3号电池、4号电池，该四节电池的标定次序为：