[发明专利]自动引导车的主动响应测量装置及控制方法

说明书

本发明公开了一种自动引导车的主动响应测量装置及控制方法，包括计算机，无线信号发射器，激光跟踪仪，设于自动引导车上的盒体，设于盒体中的数据处理器、姿态传感器、电机驱动器、无线信号接收器和电机，设于盒体上方的靶球座和设于靶球座上的被测靶球；本发明具有被测靶球可主动响应激光跟踪仪的测试光源，能够实时测量被测的自动引导车的位置数据和姿态数据的特点。

技术领域

本发明涉及自动引导车性能检测技术领域，尤其是涉及一种能够使安装在自动引导车上的被测靶球主动响应激光测量设备的测试光源，使激光测量设备能够实时测量被测自动引导车的空间位姿数据的自动引导车的主动响应测量装置及控制方法。

背景技术

近年来，我国自动引导车 (Automated Guided Vehicle，AGV)产业得到了快速发展。

现有AGV种类繁多不容易辨别其性能优劣，因为一般的被测靶球受光面角度较小，在AGV平移较大距离或旋转较大角度时，安装在 AGV上的被测靶球的受光面会偏离激光测量设备的测试光源，使激光测量设备无法对被测靶球进行测量。

发明内容

本发明的发明目的是为了克服现有技术中安装在自动引导车上的被测靶球的受光面会偏离激光测量设备的测试光源，使激光测量设备无法对被测靶球进行测量的不足，提供了一种能够使安装在自动引导车上的被测靶球主动响应激光测量设备的测试光源，使激光测量设备能够实时测量被测自动引导车的空间位姿数据的自动引导车的主动响应测量装置及控制方法。

为了实现上述目的，本发明采用以下技术方案：

一种自动引导车的主动响应测量装置，包括计算机，无线信号发射器，激光跟踪仪，设于自动引导车上的盒体，设于盒体中的数据处理器、姿态传感器、电机驱动器、无线信号接收器和电机，设于盒体上方的靶球座和设于靶球座上的被测靶球；数据处理器分别与无线信号接收器、姿态传感器和电机驱动器数据连接，电机驱动器与电机数据连接，电机的转轴上端伸出盒体之外并与靶球座连接，计算机分别与无线信号发射器和激光跟踪仪数据连接，无线信号发射器和无线信号接收器无线连接，被测靶球位于激光跟踪仪的斜下方。

作为优选，所述自动引导车为扫地机器人或叉车；所述姿态传感器为陀螺仪。

一种自动引导车的主动响应测量装置的控制方法，包括如下步骤：

3-1，激光跟踪仪测量被测靶球的位置数据P(a,z,d)；计算机控制无线信号发射器将位置数据P(a,z,d)中的a发送给无线信号接收器；

其中，a为在激光跟踪仪的测量坐标系下被测靶球相对于测量坐标系X轴的偏移角度；z为测量坐标系下被测靶球相对于测量坐标系 Z轴正方向的夹角；d为被测靶球与测量坐标系原点之间的距离；

3-2，姿态传感器获取自动引导车的姿态数据R(α,β,γ)，姿态传感器以数据处理器上电时为姿态零点R₀(α₀,β₀,γ₀)；其中，航向角α为以姿态零点R₀(α₀,β₀,γ₀)为起点，自动引导车在水平方向上移动的角度，顺时针移动的角度为正值，逆时针移动的角度为负值；β为俯仰角，γ为滚转角；

3-3，数据处理器利用位置数据P(a,z,d)、姿态数据R(α,β,γ)及上一时刻电机驱动器反馈的电机实际转动角度θ_feed，计算出电机应执行的指令角度θ_cmd；

3-4，电机驱动器将电机实际转动角度θ_feed反馈给数据处理器，数据处理器计算电机应执行的输出角度θ_out；数据处理器通过电机驱动器控制电机执行输出角度θ_out，电机带动被测靶球的受光面主动对准激光跟踪仪的测试光源。