一种三向叉车的辅助驾驶方法及系统与流程
本发明涉及仓储物流,特别是涉及一种三向叉车的辅助驾驶方法及系统。
背景技术:
1、三向叉车(也称三向堆垛车)是一种能够在窄巷道(巷道宽度通常为1.5m~2.0m)内进行高位货架存取作业的特殊叉车。与传统叉车不同,三向叉车的货叉具备侧向旋转和侧向伸缩功能,可以在不转动车体的情况下完成左右两侧货架的存取操作,因此特别适合窄巷道高密度仓储场景。
2、然而,三向叉车的操作难度远高于普通叉车,其在窄巷道内转向和定位精度要求极高,巷道两侧货架间距通常仅余10cm~20cm的较小操作余量,操作者需要长时间培训才能熟练掌握;并且对于高位货架存取时,货叉需要精确对准目标库位的托盘插孔,纵向偏差需控制在±2cm的较小精度范围以内,对操作者的空间感知能力要求极高;同时举升高度与行走定位需要同步协调,操作者需同时操控行走、转向、举升、侧移等多个动作,工作强度大且易疲劳,进而产生安全风险,另外,对于三向叉车的培训周期长,一名合格的三向叉车司机通常需要2~3个月的实操训练周期,人员流动后重新培训成本高。
技术实现思路
1、本发明提供一种三向叉车的辅助驾驶方法及系统,以解决现有技术中三向叉车的操作难度高,培训成本高,巷道两侧货架间距的操作余量较小,操作者需要长时间培训才能熟练掌握,高位货架存取时纵向偏差需控制较小精度范围以内,对操作者的空间感知能力要求极高,举升高度与行走定位需要同步协调,操作者工作强度大且易疲劳,进而产生安全风险的技术问题。
2、为实现上述目的及其他相关目的,本发明提供一种三向叉车的辅助驾驶方法,应用于三向叉车控制器,包括:获取任务指令;对任务指令进行解析,得到任务巷道编号、任务库位序号、任务库位高度和任务类型;当监测到任务巷道编号对应的第一磁地标信号时,进入磁导航辅助驾驶模式,第一磁地标信号由任务巷道编号对应磁条路径的原点磁地标获取;在磁导航辅助驾驶模式下,根据磁条路径、第一磁地标信号、磁条路径上各旁侧磁地标对应的第二磁地标信号、任务库位序号和任务库位高度进行库位定位和多维库位偏差分析,生成与任务类型对应的叉取使能信号,其中,多维库位偏差分析包括根据第一磁地标信号和第二磁地标信号,对配置在目标三向叉车行走驱动上的行走编码器进行行驶距离对应脉冲的清零校准和重新累计,并与任务库位序号对应的基准距离之间的纵向库位偏差分析,和将配置在目标三向叉车举升驱动上的举升编码器的举升高度与任务库位高度之间的垂直库位偏差分析;根据叉取使能信号,解锁任务类型对应的叉取权限,输出可叉取信号进行相应的叉取动作,以完成任务指令对应的辅助驾驶。
3、于本发明的一实施例中,获取任务指令,包括:获取相应下发系统的下发任务,下发系统包括仓储管理系统或三向叉车主机;对下发任务进行任务效验;当任务效验通过时,将下发任务作为任务指令,以获取任务指令;当任务效验失败时,进行无效任务报警。
4、于本发明的一实施例中,对下发任务进行任务效验,包括:判断下发任务是否同时满足如下条件:下发任务的接收数据帧的帧头、帧尾标识符合协议预设格式,且下发任务的接收数据长度与协议规定长度一致;接收数据帧经crc(循环冗余)校验的校验值与数据帧携带的校验字段一致;下发任务的任务库位序号在目标三向叉车的可服务范围内,下发任务的任务类型与目标三向叉车的状态匹配,下发任务的任务巷道编号满足当前巷道作业要求;当前目标三向叉车处于空闲状态,当前目标三向叉车的急停信号、安全继电器正常,当前目标三向叉车的各关键模块在线正常,关键模块包括导航系统、编码器和液压站;若是,则任务效验通过;若否,则任务效验失败。
5、于本发明的一实施例中,根据磁条路径、第一磁地标信号、磁条路径上各旁侧磁地标对应的第二磁地标信号、任务库位序号和任务库位高度进行库位定位和多维库位偏差分析,生成与任务类型对应的叉取使能信号,包括:根据第一磁地标信号控制对行走编码器的历史脉冲累计值清零;在历史脉冲累计值清零后,根据行走编码器的实时脉冲累计值、第二磁地标信号、任务库位序号和任务库位序号对应的基准距离进行磁条路径的磁导航辅助驾驶,获取纵向库位偏差;当纵向库位偏差小于第一预设阈值时,进行停车控制;在完成停车后,根据任务库位高度控制货叉进行举升动作,获取举升编码器对应的举升高度;根据举升高度和任务库位高度,获取垂直库位偏差;当垂直库位偏差小于第二预设阈值时,停止货叉举升动作,生成与任务类型对应的叉取使能信号。
6、于本发明的一实施例中,根据行走编码器的实时脉冲累计值、第二磁地标信号、任务库位序号和任务库位序号对应的基准距离进行磁条路径的磁导航辅助驾驶,获取纵向库位偏差,包括:对依次经过的各第二磁地标信号进行检测;当检测到第二磁地标信号时,对实时脉冲累计值进行清零,得到第二磁地标信号对应的绝对位置距离;根据各第二磁地标信号对应的绝对位置距离和基于末次第二磁地标信号对脉冲累计值清零后获取的末次实时脉冲累计值,得到当前行驶距离;根据当前行驶距离,判断目标三向叉车是否行驶至任务库位序号对应的预设减速区间:若是,则控制目标三向叉车进入低速爬行模式,并将低速爬行模式下的当前行驶距离与基准距离进行差值计算,获取纵向库位偏差;若否,则继续按照额定运行速度行驶。
7、于本发明的一实施例中,根据各第二磁地标信号对应的绝对位置距离和基于末次第二磁地标信号对脉冲累计值清零后获取的末次实时脉冲累计值,得到当前行驶距离,包括:根据各第二磁地标信号对应的绝对位置距离,得到累计修正距离;根据末次实时脉冲累计值、行走编码器对应的三向叉车轮径和每转脉冲数,得到末次行驶距离;根据累计修正距离和末次行驶距离,得到当前行驶距离。
8、于本发明的一实施例中,当前行驶距离的计算公式为:;其中,表示当前行驶距离,表示第个第二磁地标信号对应的绝对位置距离,表示末次实时脉冲累计值,表示每转脉冲数,表示三向叉车轮径,表示圆周率。
9、于本发明的一实施例中,根据当前行驶距离,判断目标三向叉车是否行驶至任务库位序号对应的预设减速区间,包括:将当前行驶距离与基准距离进行差值计算,得到库位距离差;判断库位距离差是否小于预设减速区间对应的最大减速距离值;若是,则目标三向叉车行驶至任务库位序号对应的预设减速区间;若否,则目标三向叉车未行驶至任务库位序号对应的预设减速区间。
10、于本发明的一实施例中,还包括:完成任务指令对应的辅助驾驶后,判断是否存在与任务巷道编号对应的同巷道任务;若是,则继续进行同巷道任务的辅助驾驶;若否,则控制目标三向叉车驶离巷道,并在驶离巷道时,进行磁地标停止检测,当检测到存在目标磁地标信号之后的磁条信号中断时,则退出磁导航辅助驾驶模式,提示切换至人工驾驶模式。
11、为实现上述目的及其他相关目的,本发明还提供一种三向叉车的辅助驾驶系统,应用于三向叉车控制器,包括:指令获取单元,用于获取任务指令;指令解析单元,用于对任务指令进行解析,得到任务巷道编号、任务库位序号、任务库位高度和任务类型;模式切换单元,用于当监测到任务巷道编号对应的第一磁地标信号时,进入磁导航辅助驾驶模式,第一磁地标信号由任务巷道编号对应磁条路径的原点磁地标获取;偏差分析单元,用于在磁导航辅助驾驶模式下,根据磁条路径、第一磁地标信号、磁条路径上各旁侧磁地标对应的第二磁地标信号、任务库位序号和任务库位高度进行库位定位和多维库位偏差分析,生成与任务类型对应的叉取使能信号,其中,多维库位偏差分析包括根据第一磁地标信号和第二磁地标信号,对配置在目标三向叉车行走驱动上的行走编码器进行行驶距离对应脉冲的清零校准和重新累计,并与任务库位序号对应的基准距离之间的纵向库位偏差分析,和将配置在目标三向叉车举升驱动上的举升编码器的举升高度与任务库位高度之间的垂直库位偏差分析;以及权限配置单元,用于根据叉取使能信号,解锁任务类型对应的叉取权限,输出可叉取信号进行相应的叉取动作,以完成任务指令对应的辅助驾驶。
12、本发明的有益效果:本发明提出的一种三向叉车的辅助驾驶方法及系统,通过与仓库管理系统或三向叉车主机等下发系统建立通信,可以实现任务信息对三向叉车控制器的自动下发,从而通过三向叉车控制器自动接收任务并解析出相应的巷道及库位信息,可以在目标三向叉车驶入巷道序号对应的巷道入口时,基于磁地标信号完成对磁导航辅助驾驶模式的自动切换,同时在磁导航辅助驾驶模式下,通过在巷道内利用行走编码器的脉冲累计值结合磁地标进行纵向库位偏差分析,同时利用举升编码器进行垂直库位偏差分析,以在精准确定到达库位后生成相应任务的叉取使能信号解锁叉取权限,以进行人工叉取,并且在叉取完成后确认无其他同巷道任务时自动驶出巷道,并切换回人工驾驶模式。通过上述方式可以实现在巷道内自动行走与自动举升,操作者仅需完成最终的叉取动作,大幅降低操作难度,进而降低三向叉车操作者的驾驶难度与培训成本,同时通过基于纵向库位偏差和垂直库位偏差的安全互锁机制确保只有在精确到位后才允许人工叉取,防止了碰撞事故,同时避免了全程自动化所需的高额改造成本和高位叉取的安全风险。
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com