[发明专利]叉车倾斜角度测量方法、设备、存储介质及装置在审
申请号: | 202011151887.6 | 申请日: | 2020-10-23 |
公开(公告)号: | CN112325847A | 公开(公告)日: | 2021-02-05 |
发明(设计)人: | 郭金虎 | 申请(专利权)人: | 劢微机器人科技(深圳)有限公司 |
主分类号: | G01C9/00 | 分类号: | G01C9/00;B66F9/075 |
代理公司: | 深圳市恒程创新知识产权代理有限公司 44542 | 代理人: | 苗广冬 |
地址: | 518000 广东省深圳市宝安区*** | 国省代码: | 广东;44 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 叉车 倾斜 角度 测量方法 设备 存储 介质 装置 | ||
1.一种叉车倾斜角度测量方法,其特征在于,所述叉车倾斜角度测量方法包括以下步骤:
获取叉车的货叉加速度信息和货叉角速度信息;
根据所述货叉加速度信息和所述货叉角速度信息确定所述叉车货叉的当前角度信息;
获取叉车的门架加速度信息和门架角速度信息;
根据所述门架加速度信息和所述门架角速度信息确定所述叉车门架的当前角度信息;
根据所述叉车货叉的当前角度信息和所述叉车门架的当前角度信息确定货叉与门架之间的相对倾斜角度。
2.如权利要求1所述的叉车倾斜角度测量方法,其特征在于,所述根据所述货叉加速度信息和所述货叉角速度信息确定所述叉车货叉的当前角度信息的步骤,包括:
根据货叉预设加速度信息和所述货叉实际加速度信息通过积分算法确定货叉角速度误差补偿值;
根据所述货叉角速度误差补偿值和所述货叉角速度信息确定叉车货叉的当前角度信息。
3.如权利要求1所述的叉车倾斜角度测量方法,其特征在于,所述根据所述门架加速度信息和所述门架角速度信息确定所述叉车门架的当前角度信息的步骤,包括:
根据门架预设加速度信息和所述门架实际加速度信息通过积分算法确定门架角速度误差补偿值;
根据所述门架角速度误差补偿值和所述门架角速度信息确定叉车门架的当前角度信息。
4.如权利要求1所述的叉车倾斜角度测量方法,其特征在于,所述根据所述叉车货叉的当前角度信息和所述叉车门架的当前角度信息确定货叉与门架之间的相对倾斜角度的步骤,包括:
根据所述叉车货叉的当前角度信息确定货叉径向角度信息;
根据所述叉车门架的当前角度信息确定门架竖直方向角度信息;
根据所述货叉径向角度信息和所述门架竖直方向角度信息确定货叉与门架之间的相对倾斜角度。
5.如权利要求1所述的叉车倾斜角度测量方法,其特征在于,所述根据所述叉车货叉的当前角度信息和所述叉车门架的当前角度信息确定货叉与门架之间的相对倾斜角度的步骤之后,还包括:
获取货叉目标前倾角度和目标后仰角度;
根据所述相对倾斜角度确定货叉当前前倾角度和货叉当前后仰角度;
根据所述货叉目标前倾角度对所述货叉当前前倾角度进行调整,并确定将货叉控制至目标位置所需的第一相对转角信息;
根据所述货叉目标后仰角度对所述货叉当前后仰角度进行调整,并确定将货叉控制至目标位置所需的第二相对转角信息。
根据所述第一相对转角信息和所述第二相对转角信息将货叉控制至目标位置。
6.如权利要求5所述的叉车倾斜角度测量方法,其特征在于,所述获取货叉目标前倾角度和目标后仰角度的步骤之前,还包括:
获取待搬运货物的重量信息;
根据所述重量信息确定所述货叉最大前倾角度或最大后仰角度;
根据所述货叉最大前倾角度确定货叉目标前倾角度;
根据所述货叉最大后仰角度确定货叉目标后仰角度。
7.如权利要求6所述的叉车倾斜角度测量方法,其特征在于,所述根据所述叉车货叉的当前角度信息和所述叉车门架的当前角度信息确定货叉与门架之间的相对倾斜角度的步骤之前,还包括:
根据所述叉车货叉的当前角度信息和所述叉车门架的当前角度信息判断所述待搬运货物是否存在倾翻风险;
在存在倾翻风险时,发出叉车预警信号。
8.一种叉车倾斜角度测量设备,其特征在于,所述叉车倾斜角度测量设备包括:存储器、处理器及存储在所述存储器上并可在所述处理器上运行的叉车倾斜角度测量程序,所述叉车倾斜角度测量程序被所述处理器执行时实现如权利要求1至7中任一项所述的叉车倾斜角度测量方法的步骤。
9.一种存储介质,其特征在于,所述存储介质上存储有叉车倾斜角度测量程序,所述叉车倾斜角度测量程序被处理器执行时实现如权利要求1至7中任一项所述的叉车倾斜角度测量方法的步骤。
10.一种叉车倾斜角度测量装置,其特征在于,所述叉车倾斜角度测量装置包括:
信息获取模块用于获取叉车的货叉加速度信息和货叉角速度信息;
信息确定模块用于根据所述货叉加速度信息和所述货叉角速度信息确定所述叉车货叉的当前角度信息;
信息获取模块还用于获取叉车的门架加速度信息和门架角速度信息;
信息确定模块还用于根据所述门架加速度信息和所述门架角速度信息确定所述叉车门架的当前角度信息;
角度确定模块用于根据所述叉车货叉的当前角度信息和所述叉车门架的当前角度信息确定货叉与门架之间的相对倾斜角度。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于劢微机器人科技(深圳)有限公司,未经劢微机器人科技(深圳)有限公司许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/202011151887.6/1.html,转载请声明来源钻瓜专利网。