一种AGV小车导航方法技术

本发明专利技术公开了一种种AGV小车导航方法，包括设置在地面上的金属带以及设置在小车上的检测组件，所述检测组件包括阵列设置的多个传感器，多个传感器分为多列并形成阵列组，每个阵列组均朝向小车移动方向排布，通过传感器的状态触发来检测小车和金属带的相对位置来进行小车状态控制；在小车移动时，每个传感器均工作并输出检测的状态；对所有传感器的输出状态进行状态积分；通过状态积分以及触发传感器的在阵列组中的位置进行轮控计算，控制小车的车轮运动方式实现姿态控制；实时的状态积分和姿态控制过程使小车沿金属带持续行走。本发明专利技术具有自动纠偏，自适应各种运行模式的功能。

A navigation method of AGV car

The invention discloses a variety of AGV car navigation methods, including a metal belt arranged on the ground and a detection component arranged on the car, the detection component includes a plurality of sensors arranged in the array, a plurality of sensors are divided into multiple columns and form an array group, each array group is arranged towards the moving direction of the car, and the phase of the car and the metal belt is detected by the state trigger of the sensor To control the position of the car; when the car moves, each sensor works and outputs the detected state; to integrate the output state of all sensors; to control the car's wheel movement by integrating the state and triggering the sensor's position in the array group, to control the car's wheel movement to achieve attitude control; real-time state integration and attitude control process Keep the trolley walking along the metal belt. The invention has the functions of automatically rectifying deviation and adapting various operation modes.

【技术实现步骤摘要】
一种AGV小车导航方法
本专利技术涉及物流
，具体涉及一种AGV小车导航方法。
技术介绍
AGV小车具有自动导引装置，能够沿规定的导引路径行驶，具有安全保护以及各种移载功能的运输车，也是工业应用中不需驾驶员的搬运车，以可用充电的蓄电池为其动力来源。通常现有技术中自动导引装置采用激光扫描、磁传感器、图像处理视觉、RFID定位、电磁以及惯性等导航技术实现。其中，采用磁导航的现有技术中，通常采用在贴路面上或埋设再浅层地下的磁条，通过磁感应信号实现导航。虽然具有较强的灵活性，易实现路径的改变或扩充，磁条易铺设的优点，但是贴于地表面或埋于浅表的磁条易受小车本身或其他通过的硬物挤压机械损伤，需要频繁对导航线路进行维护，在维护不及时或不当时常常出现导航偏差或失效。线路的维护也带来人工和材料成本的上升,并且在进行线路维护时,影响系统正常运作，造成系统正常运转率下降，降低了生产效率。通常在现有控制技术中，为了实现AGV的各种模式控制，要么使用预先设定模式，根据模式的不同来进行分别控制。要么进行硬编程，根据AGV当前位置和预设定位置的比较来判断当前的运行模式及控制方法。虽然这些方法通过传感器的反馈输入也可以实现正确控制，但是因为存在前期工作量大，并且对不同的路线必须进行预先的编程，从而降低了生产系统的运转效率。
技术实现思路
本专利技术要解决的技术问题是提供一种AGV小车导航方法，具有自动纠偏，自适应各种运行模式的功能。为了解决上述技术问题，本专利技术提供了一种AGV小车导航方法，包括设置在地面上的金属带以及设置在小车上的检测组件，所述检测组件包括阵列设置的多个传感器，多个传感器分为多列并形成阵列组，每个阵列组均朝向小车移动方向排布，传感器用于检测金属带并进行状态触发；在小车移动时，每个传感器均工作并输出检测的状态；对所有传感器的输出状态进行状态积分；通过状态积分以及触发传感器的在阵列组中的位置进行轮控计算，控制小车的车轮运动方式实现姿态控制；实时状态积分和姿态控制使小车沿金属带持续行走。进一步的，所述传感器的状态分为0和1,检测到金属带时，传感器输出检测的状态为1，输出检测的状态为1的传感器的分值总和为积分的数值。进一步的，每个阵列组中的传感器分值均不同，并且从小车的首端至尾端依次增加，沿小车前进方向的轴向两侧的阵列组的传感器分别记为负分值和正分值，根据状态积分的数值，通过非线性函数计算，分别对小车的四个车轮的旋转方向、旋转角度及当前速度状态进行控制。进一步的，以检测组件位于小车前进方向的轴向作为对称中心，将对称中心处设置为微调区，在微调区两侧设置为调整区，在两个调整区外侧设置为刹车控制区。微调区内的传感器分值之和小于调整区内的传感器分值之和，当刹车控制区的传感器触发时，启动刹车控制，刹车的快慢，强度的大小由积分数值决定。进一步的，所述小车在使用前先进行传感器安装距离调整和校核，并对传感器的状态进行复位。进一步的，所述姿态控制包括小车的四个车轮的旋转方向、旋转角度及当前的速度状态。进一步的，当进行姿态控制时，积分器采集传感器的状态数据并送入轮角向量控制器内，轮角向量控制器通过状态数据进行旋转方向判断和旋转角度计算；当旋转方向和旋转角度均0时，代表直线行走，无需调整姿态，小车的四个车轮保持或者加速运行；当旋转方向出现正负时，正和负分别对应左旋和右旋，然后分别对小车的四个车轮进行旋转方向控制，根据旋转角度对四个车轮进行姿态调整，并根据调整的旋转角度，小车的四个车轮分别单独控制，保持或者减速运行。进一步的，所述传感器为光电传感器或者磁性传感器。进一步的，所述金属带为合金钢带。进一步的，在校核状态外且为行驶状态时，当所有传感器触发或所有传感器不触发时，小车均进行刹车并停止运行；并根据系统设定的其他识别标志决定发出到位停止信号或异常停止信号。本专利技术的有益效果：金属带具有较强的硬度，因此不易损坏，降低养护次数和维护成本。通过不同位置传感器的触发能够能够判断小车与金属带之间的位置关系，并通过被触发的传感器的分值的积分，可以判断进行调节小车运行姿态，无需进行硬编程，前期无需工作量小，实现一种自动化行走的效果。附图说明图1是本专利技术的结构示意图；图2是本专利技术的使用流程图；图3是本专利技术小车传感器校核示意图；图4是本专利技术的姿态控制流程示意图；图5是本专利技术的直行右偏运行示意图；图6是本专利技术的直行左偏运行示意图；图7是本专利技术的直行旋转偏位运行示意图；图8是本专利技术的转弯触发运行示意图；图9是本专利技术的转弯运行示意图。具体实施方式下面结合附图和具体实施例对本专利技术作进一步说明，以使本领域的技术人员可以更好地理解本专利技术并能予以实施，但所举实施例不作为对本专利技术的限定。参照图1所示，本专利技术的AGV小车导航方法的一实施例，包括设置在地面上的金属带1以及设置在小车2上的检测组件3，所述检测组件包括阵列设置的多个传感器4，多个传感器分为多列并形成阵列组5，传感器用于检测金属带并进行状态触发；每个阵列组均朝向小车移动方向排布，由于金属带为长条形，因此上述的排列和组合是利于后续的积分工作，有效提高传感器检测的准确度，便于判断。上述的传感器为光电传感器或者磁性传感器，只需要能够检测到金属带即可，也可以为其他类别传感器，传感器只需要状态0和1即可(当然也可以是其他状态信号，识别便捷)，传感器的初始触发状态为零，当小车通过有金属带的区域时，传感器的触发状态为1。为了提高金属带的寿命，可以将金属带的材质选择为合金钢带，根据实际需求选择宽度即可。多个传感器和小车的四个车轮在同一平面上互相不干涉，为了更好地了解多个传感器的位置，附图中将结构放大而产生干涉，应予理解。参照图2所示，为本专利技术的使用过程，在投入使用前，为了保证传感器的有效性，先进行传感器的有效安装调节和校核，参照图3所示，在不同位置进行布置金属带，使传感器进行检测，看是否能够进行状态的触发，通过调整传感器支撑板与地面的距离，并依次使小车通过无金属带和有金属带的区域，并检测传感器的电位变化，如果所有传感器满足对应的条件，则校核完成，具体而言当小车通过无金属带的区域时，传感器的触发状态为零，当小车通过有金属带的区域时，传感器的触发状态为1，校核完成后，将所有传感器的记录状态复位。其中，阵列组包括在传感器上的个位标号标注的0、1、2、3、4、5、6、7、8、9、a、b、c，一共13组。每个阵列组内包括4个传感器，以传感器上的十位标号标注的1、2、3、4表示，四个传感器沿小车移动方向排布，因此第一组阵列组的传感器标号为10、20、30、40。校核完成后，小车既可以使用。小车移动时，每个传感器均工作并输出检测的状态，0或者1；其中，以第6组传感器设置的位置作为小车的中心位置，也就是小车移动时，与金属带配合无需调整的位置，其中第本文档来自技高网...

【技术保护点】
1.一种AGV小车导航方法，其特征在于，包括设置在地面上的金属带以及设置在小车上的检测组件，所述检测组件包括按阵列设置的多个传感器，多个传感器分为多列并形成阵列组，每个阵列组均朝向小车移动方向排布，传感器用于检测金属带并进行状态触发；/n在小车移动时，每个传感器均工作并输出检测的状态；/n根据所有传感器的输出状态进行传感器的分值的积分；/n通过积分以及触发传感器的在阵列组中的位置进行轮控计算，控制小车的车轮运动方式实现姿态控制；/n实时积分和姿态控制使小车沿金属带持续行走。/n

【技术特征摘要】
1.一种AGV小车导航方法，其特征在于，包括设置在地面上的金属带以及设置在小车上的检测组件，所述检测组件包括按阵列设置的多个传感器，多个传感器分为多列并形成阵列组，每个阵列组均朝向小车移动方向排布，传感器用于检测金属带并进行状态触发；
在小车移动时，每个传感器均工作并输出检测的状态；
根据所有传感器的输出状态进行传感器的分值的积分；
通过积分以及触发传感器的在阵列组中的位置进行轮控计算，控制小车的车轮运动方式实现姿态控制；
实时积分和姿态控制使小车沿金属带持续行走。


2.如权利要求1所述的AGV小车导航方法，其特征在于，所述传感器的状态分为0和1,检测到金属带时，传感器输出检测的状态为1，输出检测的状态为1的传感器的分值总和为积分的数值。


3.如权利要求2所述的AGV小车导航方法，其特征在于，每个阵列组中的传感器分值均不同，并且从小车的首端至尾端依次增加，沿小车前进方向的轴向两侧的阵列组的传感器分别记为负分值和正分值，根据状态积分的数值，通过非线性函数计算，分别对小车的四个车轮的旋转方向、旋转角度及当前速度状态进行控制。


4.如权利要求3所述的AGV小车导航方法，其特征在于，以检测组件位于小车前进方向的轴向作为对称中心，将对称中心处设置为微调区，在微调区两侧设置为调整区，在两个调整区外侧设置为刹车控制区。
微调区内的传感器分值之和小于调整区内的传感器分值之和，当刹车控制区的传感器触发时，启动刹车...

【专利技术属性】
技术研发人员：叶小平，叶志祥，杨卫国，温世东，程勇，
申请(专利权)人：昆山富辰迪隆智能机电科技有限公司，
类型：发明
国别省市：江苏;32