激光导航AGV及其导航方法与流程

本发明涉及运输设备领域，特别涉及叉车式agv小车。

背景技术：

agv小车，全称automatedguidedvehicle小车，可以自动导航，将货物运送到目的地，一般在物流系统或工厂内应用较多。agv小车上安装有激光扫描仪，通过激光测量agv小车与周围工作环境中的反射板的距离，从而进行导航，这种agv小车一般称为激光导航agv。但激光导航对agv小车所行驶的地面要求较高，如果地面平整度较好，激光测量的距离准确，则导航就准确。但如果地面不平整，激光测量的距离就并不真正是agv小车与周围工作环境的距离，则导航的位置就会发生错误。

技术实现要素：

鉴于目前现有技术的不足，本发明的目的在于提供一种可以精确导航的激光导航agv及其导航方法。

为达到上述目的，本发明的实施例采用如下技术方案：

一种激光导航agv，包括：控制器，用于对agv进行导航控制；激光扫描仪，用于按第一周期测量agv与周围工作环境中的反射板的距离，并传送给控制器用以进行坐标换算；倾角传感器，用于按第二周期测量agv相对于水平面的倾斜角度，并传送给控制器用以在控制器进行坐标换算时对agv与反射板的距离进行修正。

进一步，其中所述倾角传感器包括x轴倾角传感器和y轴倾角传感器，所述x轴与y轴相垂直且均与水平面平行。

进一步，其中所述控制器进行坐标换算时对agv与反射板的距离进行修正包括：x=x’*cosβ，其中x为修正后的agv与反射板的距离的x轴方向分量，x’是激光扫描仪测量得到的agv与反射板的距离的x轴方向分量，β为x轴倾角传感器测量得到的x轴倾斜角度；y=y’*cosα，其中y为修正后的agv与反射板的距离的y轴方向分量，y’是激光扫描仪测量得到的agv与反射板的距离的y轴方向分量，α为y轴倾角传感器测量得到的y轴倾斜角度。

进一步，其中所述β和α的取值范围为：-45°<β<45°，-45°<α<45°。

进一步，其中所述控制器还控制激光扫描仪旋转，并实时获取激光扫描仪传送所述agv与反射板的距离时agv相对于反射板的旋转角度，所述激光扫描仪测量得到的agv与反射板的距离的x轴方向分量和y轴方向分量为所述激光扫描仪测量得到的所述agv与反射板的距离根据所述旋转角度进行换算。

进一步，其中所述倾角传感器位于所述激光扫描仪顶部中央。

进一步，其中所述第二周期小于等于所述第一周期。

进一步，其中所述第一周期为每隔20ms发送一次，所述第二周期为每隔10ms发送一次。

进一步，其中所述倾角传感器通过现场总线与控制器相连或者两者通过各自的模拟量输入输出接口模块进行连接，所述现场总线包括ethercat、canopen。

进一步，所述反射板向下延伸到地面。

一种激光导航agv的导航方法，所述激光导航agv包括控制器、激光扫描仪以及倾角传感器，所述激光导航agv的导航方法包括：

控制器对agv进行导航控制；

激光扫描仪按第一周期测量agv与周围工作环境中的反射板的距离，并传送给控制器用以进行坐标换算；

倾角传感器按第二周期测量agv相对于水平面的倾斜角度，并传送给控制器用以在控制器进行坐标换算时对agv与反射板的距离进行修正。

进一步，其中所述倾角传感器包括x轴倾角传感器和y轴倾角传感器，所述x轴与y轴相垂直且均与水平面平行；

其中所述控制器进行坐标换算时对agv与反射板的距离进行修正包括：x=x’*cosβ，其中x为修正后的agv与反射板的距离的x轴方向分量，x’是激光扫描仪测量得到的agv与反射板的距离的x轴方向分量，β为x轴倾角传感器测量得到的x轴倾斜角度；y=y’*cosα，其中y为修正后的agv与反射板的距离的y轴方向分量，y’是激光扫描仪测量得到的agv与反射板的距离的y轴方向分量，α为y轴倾角传感器测量得到的y轴倾斜角度。

进一步，其中所述β和α的取值范围为：-45°<β<45°，-45°<α<45°。

进一步，其中所述控制器还控制激光扫描仪旋转，并实时获取激光扫描仪传送所述agv与反射板的距离时agv相对于反射板的旋转角度，所述激光扫描仪测量得到的agv与反射板的距离的x轴方向分量和y轴方向分量为所述激光扫描仪测量得到的所述agv与反射板的距离根据所述旋转角度进行换算。

进一步，其中所述第二周期小于等于所述第一周期。

进一步，其中所述第一周期为每隔20ms发送一次，所述第二周期为每隔10ms发送一次。

本发明的优点：本发明通过双轴倾角传感器，即x轴倾角传感器和y轴倾角传感器，测量agv相对于水平面的倾斜角度，从而对agv与反射板的距离的x轴方向分量和y轴方向分量进行修正，使得换算出的当前agv相对于各反射板的坐标准确，从而确保即使agv行驶在不平整地面上，导航位置也很准确。

附图说明

为了更清楚地说明本发明实施例中的技术方案，下面将对实施例中所需要使用的附图作简单地介绍，显而易见地，下面描述中的附图仅仅是本发明的一些实施例，对于本领域普通技术人员来讲，在不付出创造性劳动的前提下，还可以根据这些附图获得其他的附图。

图1为本发明一实施方式所述的一种激光导航agv在工作环境中的示意图。

图2为本发明一实施方式所述的一种激光导航agv的结构示意图以及局部放大示意图。

图3(a)、3(b)分别为本发明一实施方式所述的一种激光导航agv根据x轴倾角传感器和y轴倾角传感器测量得到的倾斜角度对agv与反射板的距离的x轴方向分量和y轴方向分量进行修正的示意图。

图4为本发明一实施方式所述的一种激光导航agv的导航方法的流程示意图。

具体实施方式

下面将结合本发明实施例中的附图，对本发明实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例仅仅是本发明一部分实施例，而不是全部的实施例。基于本发明中的实施例，本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例，都属于本发明保护的范围。

请参见图1所示，本发明一实施方式所述的一种激光导航agv在工作环境中的示意图。所述激光导航agv上安装有激光扫描仪2，所述工作环境中墙壁（或隔板壁）和/或立柱上安装有反射板4，激光导航agv的内部控制器(请参见图2中标号为1者)中设置好各反射板的相对坐标。所述激光导航agv在工作环境中行驶时，控制器1控制激光扫描仪2旋转扫描，激光扫描仪2测量得到agv与各反射板4的距离，控制器1同时获取激光扫描仪2传送agv与各反射板4的距离时所述agv相对于各反射板4的旋转角度，然后控制器1根据所述agv与各反射板4的距离和旋转角度，计算agv与反射板4的距离在x轴方向的分量和在y轴方向的分量，进而换算当前agv相对于各反射板4的坐标，进而进行导航控制。

如果agv行驶的地面，平整度较好，则上述激光导航agv可以准确的导航至目的地。但当地面的平整度不好的话，则上述激光导航agv往往会走偏，因为地面不平，使得agv倾斜，从而使得激光扫描仪2测量得到的距离并不真正是所述agv相对于各反射板4的距离。所以，本发明激光导航agv安装有倾角传感器以测量得到agv相对于水平面的倾斜角度，从而对激光扫描仪测量得到的距离进行修正，以获取agv相对各反射板的真正距离，从而保证导航精确。

请参见图2所示，本发明一实施方式所述的一种激光导航agv的倾角传感器3安装在激光扫描仪2顶部中央的位置，这样测量得到的倾斜角度最接近于激光扫描仪2的实际倾斜角度。当然，也可以安装在其他靠近激光扫描仪2的位置，不过计算时最好要考虑相应的倾角偏移量。

本发明一实施方式所述的一种激光导航agv的倾角传感器,为双轴倾角传感器中,包括x轴倾角传感器和y轴倾角传感器，所述x轴与y轴相垂直且均与水平面平行。x轴倾角传感器用于测量所述agv相对于水平面在x轴方向的倾斜角度，所述y轴倾角传感器用于测量所述agv相对于水平面在y轴方向的倾斜角度。

所述控制器1进行坐标换算时，对agv与反射板4的距离进行修正。其中包括：x=x’*cosβ，其中x为修正后的agv与反射板4的距离的x轴方向分量，也即agv与反射板4的距离在x轴方向的分量的真正数值，x’是激光扫描仪2测量得到的agv与反射板4的距离的x轴方向分量，β为x轴倾角传感器测量得到的x轴倾斜角度；y=y’*cosα，其中y为修正后的agv与反射板4的距离的y轴方向分量，也即agv与反射板4的距离在y轴方向的分量的真正数值，y’是激光扫描仪2测量得到的agv与反射板4的距离的y轴方向分量，α为y轴倾角传感器测量得到的y轴倾斜角度。

其中，所述β和α的取值范围为：-45°<β<45°，-45°<α<45°。

激光扫描仪2，是按第一周期测量agv与反射板4的距离，并传送给控制器1进行坐标换算；倾角传感器3，是按第二周期测量agv相对于水平面的倾斜角度，并传送给控制器1。所述第二周期最好小于等于所述第一周期，这样计算才会更精确。在本实施方式中，所述第一周期为每隔20ms测量并传送一次，即每秒更新6次位置；所述第二周期为每隔10ms测量并传送一次，当然隔15ms或20ms也可以，只要不大于第一周期即可。

所述倾角传感器3通过现场总线与控制器1相连或者两者通过各自的模拟量输入输出接口模块进行连接，以进行数据的快速传送。所述现场总线包括ethercat、canopen等。

所述反射板4可以距离地面有一定距离，也可以向下延伸到地面，以确保能接受到激光扫描仪发出的激光。

请参见图4所示，本发明一实施方式所述的一种激光导航agv的导航方法，所述激光导航agv包括控制器、激光扫描仪以及倾角传感器，所述激光导航agv的导航方法包括：

控制器对agv进行导航控制；

激光扫描仪按第一周期测量agv与周围工作环境中的反射板的距离，并传送给控制器用以进行坐标换算；

倾角传感器按第二周期测量agv相对于水平面的倾斜角度，并传送给控制器用以在控制器进行坐标换算时对agv与反射板的距离进行修正。

其中，所述倾角传感器包括x轴倾角传感器和y轴倾角传感器，所述x轴与y轴相垂直且均与水平面平行。所述控制器进行坐标换算时对agv与反射板的距离进行修正，包括：x=x’*cosβ，其中x为修正后的agv与反射板的距离的x轴方向分量，x’是激光扫描仪测量得到的agv与反射板的距离的x轴方向分量，β为x轴倾角传感器测量得到的x轴倾斜角度；y=y’*cosα，其中y为修正后的agv与反射板的距离的y轴方向分量，y’是激光扫描仪测量得到的agv与反射板的距离的y轴方向分量，α为y轴倾角传感器测量得到的y轴倾斜角度。

其中，所述β和α的取值范围为：-45°<β<45°，-45°<α<45°。

所述控制器还控制激光扫描仪旋转，并实时获取激光扫描仪传送所述agv与反射板的距离时agv相对于反射板的旋转角度，所述激光扫描仪测量得到的agv与反射板的距离的x轴方向分量和y轴方向分量为所述激光扫描仪测量得到的所述agv与反射板的距离根据所述旋转角度进行换算。

所述第二周期最好小于等于所述第一周期，这样计算才会更精确。在本实施方式中，所述第一周期为每隔20ms测量并传送一次，即每秒更新6次位置；所述第二周期为每隔10ms测量并传送一次，当然隔15ms或20ms也可以，只要不大于第一周期即可。本发明通过双轴倾角传感器3，即x轴倾角传感器和y轴倾角传感器，测量agv相对于水平面的倾斜角度，从而对agv与反射板4的距离的x轴方向分量和y轴方向分量进行修正，使得换算出的当前agv相对于各反射4板的坐标准确，从而确保即使agv行驶在不平整地面上，导航位置也很准确。

以上所述，仅为本发明的具体实施方式，但本发明的保护范围并不局限于此，任何熟悉本领域技术的技术人员在本发明公开的技术范围内，可轻易想到的变化或替换，都应涵盖在本发明的保护范围之内。因此，本发明的保护范围应以所述权利要求的保护范围为准。