一种用于防爆仓库的无源视觉导航无人叉车系统和导航方法技术方案

本发明专利技术公开一种用于防爆仓库的无源视觉导航无人叉车系统，包括叉车本体，调度装置、防爆摄像头、防爆控制器、感应器、报警器、机械防撞装置，通过对叉车实时的信标信息与储存的相对应的信标信息处理分析，来确定叉车实时位置，且在行进中不停对路径进行最优路径选择，直至到达目标位置。本发明专利技术实现防爆仓库内无源视觉导航无人化操作，避免危害人体健康，降低人力投入，提高作业效率，缩短工作时间。

A Passive Visual Navigation Unmanned Forklift System and Navigation Method for Explosion-proof Warehouse

【技术实现步骤摘要】
一种用于防爆仓库的无源视觉导航无人叉车系统和导航方法
本专利技术涉及无人驾驶车辆
，尤其涉及用于防爆仓库，并且能够结合环境信息进行自主定位导航并且避障的无人叉车系统和导航方法。
技术介绍
防爆标准把爆炸物性质分为：I类，主要为甲烷(矿井下环境)；II类，爆炸性气体及混合物(气体环境)；III类，可燃性粉尘(粉尘环境)。在此基础上，根据防爆仓库中爆炸性混合物出现的频繁程度、持续时间和危险程度对其进行级别划分：A，爆炸性气体环境的2区、1区和0区，从左至右，爆炸混合物出现越频繁，持续时间越长；B，可燃性粉尘环境的22区、21区、20区，从左至右，爆炸混合物出现越频繁，持续时间越长。其中2区和22区指正常运行时，爆炸性环境偶发性存在，每年积累存在的时间小于10小时的场所。可燃性气体的引燃温度划分为T1，T2，T3，T4，T5，T6六个组别，从左至右，引燃温度逐渐降低。其中T4级别的引燃温度在135°-200°之间。尽管防爆仓库的危险性如此之高，但是目前的防爆仓库仍处于原始的人工操作阶段，存在人工成本高、效率低、危害人体健康等问题，而无人叉车可以一定程度上地解决在搬运过程中的人工问题，降低人力投入，提升作业效率。
技术实现思路
为了解决上述技术问题，本专利技术提出一种在含有IIA、IIB级，T1-T4组爆炸性气体环境2区场所等防爆场景内工作的一种用于防爆仓库的无源视觉导航无人叉车系统和导航方法。为了达到上述目的，本专利技术的技术方案如下：一种用于防爆仓库的无源视觉导航无人叉车系统，包括：叉车，其特征在于，还包括：调度装置、防爆摄像头、防爆控制器、感应器、报警器、机械防撞装置，所述防爆控制器集成有主控制器、驱动控制器和叉车控制器，所述调度装置与所述主控制器网络连接，所述主控制器与所述驱动控制器有线连接，所述驱动控制器与所述叉车控制器有线连接，所述防爆摄像头与所述主控制器有线连接，所述感应器、报警器和机械防撞装置与所述驱动控制器有线连接，所述防爆摄像头、所述防爆控制器、所述感应器、所述报警器和所述机械防撞装置均安装在叉车上，所述调度装置，用于实现用户与主控制器的交互；所述防爆摄像头，用于采集天花板图片；所述主控制器，又包括：储存模块、分析处理模块和通讯模块，所述分析处理模块，用于分析、计算防爆摄像头采集的天花板图片以获得天花板图片信息；所述储存模块，用于储存所述天花板图片和天花板图片信息；所述通讯模块，用于与所述调度装置通讯，应答所述调度装置的命令，给驱动器下达命令；所述驱动控制器，用于收集来自感应器的感应信号并上传到防爆控制器，响应主控制器的命令；所述叉车控制器,用于协调和指挥叉车；所述感应器，用于实时感应叉车周边环境并将感应信号发送给所述驱动控制器；所述报警器，用于输出声和/或光信号；所述机械防撞装置，用于防止叉车发生碰撞。进一步，所述感应器包括超声波探头、安全避障雷达、光电传感器、激光测距和避障传感器。一种用于防爆仓库的无源视觉导航无人叉车的导航方法，包括以下步骤:A1:设置多个均匀散布的自然信标点；将叉车置于每个自然信标点的状态作为移动自然信标；采集上方天花板的图片，将采集到的天花板图片作为该自然信标点的天花板自然信标；将每一个自然信标点的位置信息、移动自然信标和天花板自然信标进行关联并存储；A2：输入叉车的目标位置；A3：叉车运动后，实时计算叉车的位置；A4：采集叉车上方的天花板的实时全局图片与局部图片，其中全局图片包含防爆摄像头能够看到的所有内容，局部图片是根据前一时间点的信标信息在全局图片内切割出来的子图片，提取天花板局部图片中的实时信标信息，所述实时信标信息包括信标中心点、实时的信标角度、实时的叉车角度和图片中心点；A5:判断对比前一时间点的信标信息和实时信标信息是否匹配，是，则采用实时信标信息进行定位；否，则采集天花板全局图片，将实时信标信息与全局的信标信息进行匹配，用匹配到的信标信息进行定位；A6：将A4中匹配得到的信标信息与存储的相对应的信标信息进行对比，根据差量计算出叉车的实时位置；A7：控制叉车进行运动。进一步，主控制器对天花板图片、全局图片、局部图片先进行预处理，所述预处理包括滤波处理和腐蚀膨胀处理。进一步，所述步骤A6后还包括步骤如下：B1：叉车在当前位置到目标位置间，不断的对地图中每一个可能的搜索位置进行评估直到达到目标位置，得到一系列可能的路径及其匹配的花费；B2:根据每一条可能路径的路径花费、转弯角度、冲突点的设置及其这些因素相应的权重，得到每一条可能路径的分数；B3：选取分数最高的一条的可能路径，这条可能路径中一系列节点形成了从叉车当前位置到达目标所致索要经过的顺序点集。进一步，所述步骤B3后还包括步骤如下：C1：获得顺序点集，并在节点信息中进行插补。进一步，还包括步骤如下：D1：机械防爆装置被触发，则叉车立即停止工作；机械防爆装置未被触发，叉车感应器检测到周围有障碍物，则叉车立即停止工作并触发报警器，直到感应器检测不到障碍物。进一步，所述通过实时信标信息和存储的相对应的信标信息的差量通过以下方法计算：A6-1)将实时信标中心点与图像中心的差量与相对应的储存的信标中心点与图像中心点的差量进行比较，其中对图片中信标的角度的不同经过了旋转矩阵R1的矫正；A6-2)将比较的结果经过比例系数k的作用从图像放大到现实世界，再经过旋转矩阵R2的矫正，使实时的信标中心点与对应的存储的信标中心点位于同一个现实坐标系下；A6-3)根据对应的存储的信标信息中的位置信息和位于同一现实坐标系下实时信标中心点与存储信标中心点的距离差求出叉车实时的位置信息，计算公式为：x＝(k*((rc-u0)-(rp-u0)*R1))*R2+lpθf＝θs其中：x是表示叉车实时的现实位置，k是实时检测的每一个像素代表的现实长度的比例，lp表示每一个自然信标点的位置信息，θp表示移动自然信标，rp表示天花板自然信标，rc表示实时的信标中心点，θs表示实时的信标角度，θf表示实时的叉车角度，u0表示图像中心点。进一步，所述设叉车的实时位置为初始点，叉车的目标位置为目标点，距离的计算采用曼哈顿距离计算方式，为：d＝|x1-x2|+|y1-y2|其中d代表了两点之间的距离，(x1,y1)，(x2,y2)为计算的两个点；从初始点开始搜索其的子节点，根据公式：f(n)＝g(n)+h(n)计算从初始节点开始的到中间节点n的分数，其中f(n)是从初始节点经过中间节点n的估价函数，g(n)是从初始节点到中间节点n的实际代价，h(n)是从中间节点n到目标点最优路径的估计代价，其中估价函数的系数公式为：p＝(p1*angle+p2*used)*p3p1+p2＝1其中angle指路径上会经过的所有角度之和；used指该路径上其他车的数量。p是对当前路径估价获得的总的系数，p1，p2，p3是不同因素的权重，p1是该路径旋转角度的系数，p2是该路径当前是否有其他叉车使用的系数，p3是改路径上是否有障碍物的系数，当路径上没有障碍物时，p3＝1，否则p3会选取一个极大数，使这条路径不可能被选择，得到系数之后，当前路径的分数可以有公式：s＝p*f(n)其中s为当前路径的分数，p是对当前路径估价获得的总的系数，获得分数之后，选取各个可能路径中分数最本文档来自技高网...

【技术保护点】
1.一种用于防爆仓库的无源视觉导航无人叉车系统，包括：叉车，其特征在于，还包括：调度装置、防爆摄像头、防爆控制器、感应器、报警器、机械防撞装置，所述防爆控制器集成有主控制器、驱动控制器和叉车控制器，所述调度装置与所述主控制器网络连接，所述主控制器与所述驱动控制器有线连接，所述驱动控制器与所述叉车控制器有线连接，所述防爆摄像头与所述主控制器有线连接，所述感应器、报警器和机械防撞装置与所述驱动控制器有线连接，所述防爆摄像头、所述防爆控制器、所述感应器、所述报警器和所述机械防撞装置均安装在叉车上，所述调度装置，用于实现用户与主控制器的交互；所述防爆摄像头，用于采集天花板图片；所述主控制器，又包括：储存模块、分析处理模块和通讯模块，所述分析处理模块，用于分析、计算防爆摄像头采集的天花板图片以获得天花板图片信息；所述储存模块，用于储存所述天花板图片和天花板图片信息；所述通讯模块，用于与所述调度装置通讯，应答所述调度装置的命令，给驱动控制器下达命令；所述驱动控制器，用于收集来自感应器的感应信号并上传到防爆控制器，响应主控制器的命令；所述叉车控制器,用于协调和指挥叉车；所述感应器，用于实时感应叉车周边环境并将感应信号发送给所述驱动控制器；所述报警器，用于输出声和/或光信号；所述机械防撞装置，用于防止叉车发生碰撞。...

【技术特征摘要】
1.一种用于防爆仓库的无源视觉导航无人叉车系统，包括：叉车，其特征在于，还包括：调度装置、防爆摄像头、防爆控制器、感应器、报警器、机械防撞装置，所述防爆控制器集成有主控制器、驱动控制器和叉车控制器，所述调度装置与所述主控制器网络连接，所述主控制器与所述驱动控制器有线连接，所述驱动控制器与所述叉车控制器有线连接，所述防爆摄像头与所述主控制器有线连接，所述感应器、报警器和机械防撞装置与所述驱动控制器有线连接，所述防爆摄像头、所述防爆控制器、所述感应器、所述报警器和所述机械防撞装置均安装在叉车上，所述调度装置，用于实现用户与主控制器的交互；所述防爆摄像头，用于采集天花板图片；所述主控制器，又包括：储存模块、分析处理模块和通讯模块，所述分析处理模块，用于分析、计算防爆摄像头采集的天花板图片以获得天花板图片信息；所述储存模块，用于储存所述天花板图片和天花板图片信息；所述通讯模块，用于与所述调度装置通讯，应答所述调度装置的命令，给驱动控制器下达命令；所述驱动控制器，用于收集来自感应器的感应信号并上传到防爆控制器，响应主控制器的命令；所述叉车控制器,用于协调和指挥叉车；所述感应器，用于实时感应叉车周边环境并将感应信号发送给所述驱动控制器；所述报警器，用于输出声和/或光信号；所述机械防撞装置，用于防止叉车发生碰撞。2.根据权利要求1所述的一种用于防爆仓库的无源视觉导航无人叉车系统，其特征在于，所述感应器包括超声波探头、安全避障雷达、光电传感器、激光测距和避障传感器。3.一种用于防爆仓库的无源视觉导航无人叉车的导航方法，其特征在于，包括以下步骤:A1:设置多个均匀散布的自然信标点；将叉车置于每个自然信标点的状态作为移动自然信标；采集上方天花板的图片，将采集到的天花板图片作为该自然信标点的天花板自然信标；将每一个自然信标点的位置信息、移动自然信标和天花板自然信标进行关联并存储；A2：输入叉车的目标位置；A3：叉车运动后，实时计算叉车的位置；A4：采集叉车上方的天花板的实时全局图片与局部图片，其中全局图片包含防爆摄像头能够看到的所有内容，局部图片是根据前一时间点的信标信息在全局图片内切割出来的子图片，提取天花板局部图片中的实时信标信息，所述实时信标信息包括信标中心点、实时的信标角度、实时的叉车角度和图片中心点；A5:判断对比前一时间点的信标信息和实时信标信息是否匹配，是，则采用实时信标信息进行定位；否，则采集天花板全局图片，将实时信标信息与全局的信标信息进行匹配，用匹配到的信标信息进行定位；A6：将A4中匹配得到的信标信息与存储的相对应的信标信息进行对比，根据差量计算出叉车的实时位置；A7：控制叉车进行运动。4.根据权利要求3所述的一种用于防爆仓库的无源视觉导航无人叉车的导航方法，其特征在于，主控制器对天花板图片、全局图片、局部图片先进行预处理，所述预处理包括滤波处理和腐蚀膨胀处理。5.根据权利要求3所述的一种用于防爆仓库的无源视觉导航无人叉车的导航方法，其特征在于，所述步骤A6后还包括步骤如下：B1：叉车在当前位置到目标位置间，不断的对地图中每一个可能的搜索位置进行评估直到达到目标位置，得到一系列可能的路径及其匹配的...

【专利技术属性】
技术研发人员：胡佳琪，王志，刘佳奇，伍志峰，王国成，裴翔，
申请(专利权)人：杭州国辰牵星科技有限公司，
类型：发明
国别省市：浙江,33