详情

原文传递一种用于防爆仓库的无源视觉导航无人叉车系统和导航方法

专利名称：	一种用于防爆仓库的无源视觉导航无人叉车系统和导航方法
摘要：	本发明公开一种用于防爆仓库的无源视觉导航无人叉车系统，包括叉车本体，调度装置、防爆摄像头、防爆控制器、感应器、报警器、机械防撞装置，通过对叉车实时的信标信息与储存的相对应的信标信息处理分析，来确定叉车实时位置，且在行进中不停对路径进行最优路径选择，直至到达目标位置。本发明实现防爆仓库内无源视觉导航无人化操作，避免危害人体健康，降低人力投入，提高作业效率，缩短工作时间。
专利类型：	发明专利
国家地区组织代码：	浙江;33
申请人：	杭州国辰牵星科技有限公司
发明人：	胡佳琪;王志;刘佳奇;伍志峰;王国成;裴翔
专利状态：	有效
申请日期：	2019-04-08T00:00:00+0800
发布日期：	2019-07-19T00:00:00+0800
申请号：	CN201910276428.1
公开号：	CN110028017A
代理机构：	苏州中合知识产权代理事务所(普通合伙)
代理人：	赵晓芳
分类号：	B66F9/06(2006.01);B;B66;B66F;B66F9
申请人地址：	311200 浙江省杭州市萧山经济开发区建设二路957号
主权项：	1.一种用于防爆仓库的无源视觉导航无人叉车系统，包括：叉车，其特征在于，还包括：调度装置、防爆摄像头、防爆控制器、感应器、报警器、机械防撞装置，所述防爆控制器集成有主控制器、驱动控制器和叉车控制器，所述调度装置与所述主控制器网络连接，所述主控制器与所述驱动控制器有线连接，所述驱动控制器与所述叉车控制器有线连接，所述防爆摄像头与所述主控制器有线连接，所述感应器、报警器和机械防撞装置与所述驱动控制器有线连接，所述防爆摄像头、所述防爆控制器、所述感应器、所述报警器和所述机械防撞装置均安装在叉车上，所述调度装置，用于实现用户与主控制器的交互；所述防爆摄像头，用于采集天花板图片；所述主控制器，又包括：储存模块、分析处理模块和通讯模块，所述分析处理模块，用于分析、计算防爆摄像头采集的天花板图片以获得天花板图片信息；所述储存模块，用于储存所述天花板图片和天花板图片信息；所述通讯模块，用于与所述调度装置通讯，应答所述调度装置的命令，给驱动控制器下达命令；所述驱动控制器，用于收集来自感应器的感应信号并上传到防爆控制器，响应主控制器的命令；所述叉车控制器,用于协调和指挥叉车；所述感应器，用于实时感应叉车周边环境并将感应信号发送给所述驱动控制器；所述报警器，用于输出声和/或光信号；所述机械防撞装置，用于防止叉车发生碰撞。 2.根据权利要求1所述的一种用于防爆仓库的无源视觉导航无人叉车系统，其特征在于，所述感应器包括超声波探头、安全避障雷达、光电传感器、激光测距和避障传感器。 3.一种用于防爆仓库的无源视觉导航无人叉车的导航方法，其特征在于，包括以下步骤: A1:设置多个均匀散布的自然信标点；将叉车置于每个自然信标点的状态作为移动自然信标；采集上方天花板的图片，将采集到的天花板图片作为该自然信标点的天花板自然信标；将每一个自然信标点的位置信息、移动自然信标和天花板自然信标进行关联并存储； A2：输入叉车的目标位置； A3：叉车运动后，实时计算叉车的位置； A4：采集叉车上方的天花板的实时全局图片与局部图片，其中全局图片包含防爆摄像头能够看到的所有内容，局部图片是根据前一时间点的信标信息在全局图片内切割出来的子图片，提取天花板局部图片中的实时信标信息，所述实时信标信息包括信标中心点、实时的信标角度、实时的叉车角度和图片中心点； A5:判断对比前一时间点的信标信息和实时信标信息是否匹配，是，则采用实时信标信息进行定位；否，则采集天花板全局图片，将实时信标信息与全局的信标信息进行匹配，用匹配到的信标信息进行定位； A6：将A4中匹配得到的信标信息与存储的相对应的信标信息进行对比，根据差量计算出叉车的实时位置； A7：控制叉车进行运动。 4.根据权利要求3所述的一种用于防爆仓库的无源视觉导航无人叉车的导航方法，其特征在于，主控制器对天花板图片、全局图片、局部图片先进行预处理，所述预处理包括滤波处理和腐蚀膨胀处理。 5.根据权利要求3所述的一种用于防爆仓库的无源视觉导航无人叉车的导航方法，其特征在于，所述步骤A6后还包括步骤如下： B1：叉车在当前位置到目标位置间，不断的对地图中每一个可能的搜索位置进行评估直到达到目标位置，得到一系列可能的路径及其匹配的花费； B2:根据每一条可能路径的路径花费、转弯角度、冲突点的设置及其这些因素相应的权重，得到每一条可能路径的分数； B3：选取分数最高的一条的可能路径，这条可能路径中一系列节点形成了从叉车当前位置到达目标所致索要经过的顺序点集。 6.根据权利要求5所述的一种用于防爆仓库的无源视觉导航无人叉车的导航方法，其特征在于，所述步骤B3后还包括步骤如下： C1：获得顺序点集，并在节点信息中进行插补。 7.根据权利要求3或5所述的一种用于防爆仓库的无源视觉导航无人叉车的导航方法，其特征在于，还包括步骤如下： D1：机械防爆装置被触发，则叉车立即停止工作；机械防爆装置未被触发，叉车感应器检测到周围有障碍物，则叉车立即停止工作并触发报警器，直到感应器检测不到障碍物。 8.根据权利要求3所述的一种用于防爆仓库的无源视觉导航无人叉车的导航方法，其特征在于，所述通过实时信标信息和存储的相对应的信标信息的差量通过以下方法计算： 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表示图像中心点。 9.根据权利要求5所述的一种用于防爆仓库的无源视觉导航无人叉车的导航方法，其特征在于，所述设叉车的实时位置为初始点，叉车的目标位置为目标点，距离的计算采用曼哈顿距离计算方式，为： 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＝(p1angle+p2used)p3 p1+p2＝1 其中p是对当前路径估价获得的总的系数，p1，p2，p3是不同因素的权重，p1是该路径旋转角度的系数，p2是该路径当前是否有其他叉车使用的系数，p3是改路径上是否有障碍物的系数，当路径上没有障碍物时，p3＝1，否则p3会选取一个极大数，使这条路径不可能被选择，得到系数之后，当前路径的分数可以有公式： s＝p*f(n) 其中s为当前路径的分数，p是对当前路径估价获得的总的系数，获得分数之后，选取各个可能路径中分数最小的一条作为这一步选定的中间节点。
所属类别：	发明专利