自动引导车的主动响应测量装置及控制方法制造方法及图纸

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

【技术实现步骤摘要】
自动引导车的主动响应测量装置及控制方法


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

技术介绍

[0002]近年来，我国自动引导车 (Automated Guided Vehicle，AGV)产业得到了快速发展。
[0003]现有AGV种类繁多不容易辨别其性能优劣，因为一般的被测靶球受光面角度较小，在AGV平移较大距离或旋转较大角度时，安装在 AGV上的被测靶球的受光面会偏离激光测量设备的测试光源，使激光测量设备无法对被测靶球进行测量。

技术实现思路

[0004]本专利技术的专利技术目的是为了克服现有技术中安装在自动引导车上的被测靶球的受光面会偏离激光测量设备的测试光源，使激光测量设备无法对被测靶球进行测量的不足，提供了一种能够使安装在自动引导车上的被测靶球主动响应激光测量设备的测试光源，使激光测量设备能够实时测量被测自动引导车的空间位姿数据的自动引导车的主动响应测量装置及控制方法。
[0005]为了实现上述目的，本专利技术采用以下技术方案：
[0006]一种自动引导车的主动响应测量装置，包括计算机，无线信号发射器，激光跟踪仪，设于自动引导车上的盒体，设于盒体中的数据处理器、姿态传感器、电机驱动器、无线信号接收器和电机，设于盒体上方的靶球座和设于靶球座上的被测靶球；数据处理器分别与无线信号接收器、姿态传感器和电机驱动器数据连接，电机驱动器与电机数据连接，电机的转轴上端伸出盒体之外并与靶球座连接，计算机分别与无线信号发射器和激光跟踪仪数据连接，无线信号发射器和无线信号接收器无线连接，被测靶球位于激光跟踪仪的斜下方。
[0007]作为优选，所述自动引导车为扫地机器人或叉车；所述姿态传感器为陀螺仪。
[0008]一种自动引导车的主动响应测量装置的控制方法，包括如下步骤：
[0009]3‑
1，激光跟踪仪测量被测靶球的位置数据P(a,z,d)；计算机控制无线信号发射器将位置数据P(a,z,d)中的a发送给无线信号接收器；
[0010]其中，a为在激光跟踪仪的测量坐标系下被测靶球相对于测量坐标系X轴的偏移角度；z为测量坐标系下被测靶球相对于测量坐标系 Z轴正方向的夹角；d为被测靶球与测量坐标系原点之间的距离；
[0011]3‑
2，姿态传感器获取自动引导车的姿态数据R(α,β,γ)，姿态传感器以数据处理器上电时为姿态零点R0(α0,β0,γ0)；其中，航向角α为以姿态零点R0(α0,β0,γ0)为起点，自动引导车在水平方向上移动的角度，顺时针移动的角度为正值，逆时针移动的角度为负值；β为俯仰角，γ为滚转角；
[0012]3‑
3，数据处理器利用位置数据P(a,z,d)、姿态数据R(α,β,γ)及上一时刻电机驱动器反馈的电机实际转动角度θ
feed
，计算出电机应执行的指令角度θ
cmd
；
[0013]3‑
4，电机驱动器将电机实际转动角度θ
feed
反馈给数据处理器，数据处理器计算电机应执行的输出角度θ
out
；数据处理器通过电机驱动器控制电机执行输出角度θ
out
，电机带动被测靶球的受光面主动对准激光跟踪仪的测试光源。
[0014]本专利技术将被测靶球的位置数据作为被测AGV的位置数据，使安装在自动引导车上的被测靶球主动响应激光测量设备的测试光源，使激光跟踪仪能够实时测量被测的自动引导车的位置数据；
[0015]本专利技术采用无线操作，无需人工接触被测靶球即可完成AGV性能测量；可动态测量，具备自动定位和跟踪活动目标的功能；测量方便，可以实时测出自动引导车在任何点位的位置数据和姿态数据。
[0016]计算机得到被测AGV的位置数据、姿态数据后，可进行AGV 的定位性能、重复定位性能、导航路程误差、导航时间误差等性能测试。
[0017]作为优选，步骤3
‑
1包括如下具体步骤：
[0018]计算机利用位置数据P(a,z,d)计算坐标数据P
′
(Px,Py,Pz)：其中，Px＝d
×
sin(z)
×
sin(a)
[0019]Py＝d
×
sin(z)
×
cos(a)
[0020]Pz＝d
×
cos(z)；
[0021]计算机利用P
′
(Px,Py,Pz)计算被测靶球的位置准确度和轨迹准确度，将被测靶球的位置准确度和轨迹准确度作为自动引导车的位置准确度和轨迹准确度。
[0022]作为优选，步骤3
‑
3包括如下具体步骤：
[0023]3‑3‑
1，数据处理器将位置数据P(a,z,d)中的被测靶球相对于激光跟踪仪的测量坐标系X轴的当前时刻偏移角度a
i
,和姿态数据R(α,β,γ)中的当前时刻航向角α
i
，均从[
‑
π,π]转化到[0,2π]；
[0024]3‑3‑
2，数据处理器计算a
i
与上一时刻偏移角度a
i
‑1的偏差dta
i
，α
i
与上一时刻航向角α
i
‑1的偏差dtα
i
，将dta
i
和dtα
i
均用[0,2π]范围内的角度值表示；
[0025]3‑3‑
3，
[0026]当dta
i
＜0、dtα
i
＜0并且dta
i
＞dtα
i
[0027]或者dta
i
＞0、dtα
i
＞0并且dta
i
＞dtα
i
；
[0028]表示被测靶球偏离激光跟踪仪的角度方向与其自转角度方向相同，则θ
cmd
＝dta
i
；
[0029]当dta
i
和dtα
i
中一个为正值，另一个为负值，表示被测靶球偏离激光跟踪仪的角度方向与其自转角度方向相反，则θ
cmd
＝dta
i
+dtα
i
；
[0030]当dta
i
和dtα
i
中的一个为零时，则θ
cmd
等于另一个不为零的角度值。
[0031]作为优选，数据处理器利用θ
cmd
和θ
feed
计算出电机应执行的输出角度θ
out
：
[0032]θ
out
＝K
本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种自动引导车的主动响应测量装置，其特征是，包括计算机(4)，无线信号发射器(41)，激光跟踪仪(42)，设于自动引导车(1)上的盒体(2)，设于盒体中的数据处理器(21)、姿态传感器(22)、电机驱动器(23)、无线信号接收器(24)和电机(25)，设于盒体上方的靶球座(3)和设于靶球座上的被测靶球(31)；数据处理器分别与无线信号接收器、姿态传感器和电机驱动器数据连接，电机驱动器与电机数据连接，电机的转轴上端伸出盒体之外并与靶球座连接，计算机分别与无线信号发射器和激光跟踪仪数据连接，无线信号发射器和无线信号接收器无线连接，被测靶球位于激光跟踪仪的斜下方。2.根据权利要求1所述的自动引导车的主动响应测量装置，其特征是，所述自动引导车为扫地机器人或叉车；所述姿态传感器为陀螺仪。3.一种适用于权利要求1所述的自动引导车的主动响应测量装置的控制方法，其特征是，包括如下步骤：3
‑
1，激光跟踪仪测量被测靶球的位置数据P(a,z,d)；计算机控制无线信号发射器将位置数据P(a,z,d)中的a发送给无线信号接收器；其中，a为在激光跟踪仪的测量坐标系下被测靶球相对于测量坐标系X轴的偏移角度；z为测量坐标系下被测靶球相对于测量坐标系Z轴正方向的夹角；d为被测靶球与测量坐标系原点之间的距离；3
‑
2，姿态传感器获取自动引导车的姿态数据R(α,β,γ)，姿态传感器以数据处理器上电时为姿态零点R0(α0,β0,γ0)；其中，航向角α为以姿态零点R0(α0,β0,γ0)为起点，自动引导车在水平方向上移动的角度，顺时针移动的角度为正值，逆时针移动的角度为负值；β为俯仰角，γ为滚转角；3
‑
3，数据处理器利用位置数据P(a,z,d)、姿态数据R(α,β,γ)及上一时刻电机驱动器反馈的电机实际转动角度θ
feed
，计算出电机应执行的指令角度θ
cmd
；3
‑
4，电机驱动器将电机实际转动角度θ
feed
反馈给数据处理器，数据处理器计算电机应执行的输出角度θ
out
；数据处理器通过电机驱动器控制电机执行输出角度θ
out
，电机带动被测靶球的受光面主动对准激光跟踪仪的测试光源。4.根据权利要求3所述的自动引导车的主动响应测量装置的控制方法，其特征是，步骤3
‑
1包括如下具体步骤：计算机利用位置数据P(a,z,d)计算坐标数据P
′
(Px,Py,Pz)：其中，Px＝d
×
sin(z)
×
sin(a)Py＝d
×
sin(z)
×
cos(a)Pz＝d
×
cos(z)；计算机利用P
′
(Px,Py,Pz)计算被测靶球的位置准确度和轨迹准确度，将被测靶球的位置准确度和轨迹准确度作为自动引导车的位置准确度和轨迹准确度。5.根据权利要求3...

【专利技术属性】
技术研发人员：陈章位，张翔，林威威，祖洪飞，
申请(专利权)人：浙江谱麦科技有限公司，
类型：发明
国别省市：