[发明专利]一种无人智能洗地机的转向控制方法及系统有效
申请号: | 202111682210.X | 申请日: | 2021-12-31 |
公开(公告)号: | CN114194285B | 公开(公告)日: | 2023-05-26 |
发明(设计)人: | 黄超;黄云南 | 申请(专利权)人: | 上海仙途智能科技有限公司 |
主分类号: | B62D5/04 | 分类号: | B62D5/04 |
代理公司: | 北京博思佳知识产权代理有限公司 11415 | 代理人: | 靳玫 |
地址: | 201600 上海*** | 国省代码: | 上海;31 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 一种 无人 智能 地机 转向 控制 方法 系统 | ||
1.一种无人智能洗地机的转向控制方法,所述无人智能洗地机上安装了舵轮,以及与所述舵轮连接的编码器,所述舵轮的轴向与所述编码器的轴向满足预设的第一位置关系,所述方法包括:
接收转向请求,所述转向请求包括所述舵轮转动的目标角度;其中,所述目标角度对应数值的正负表示所述舵轮转动的方向;
根据当前角度以及所述目标角度,以及第一齿轮和第二齿轮的传动比,计算用于驱动所述舵轮转向的转向电机的旋转速度和旋转方向,并根据所述旋转速度和所述旋转方向控制所述转向电机转动;其中,所述转向电机的轴向与所述舵轮的轴向满足预设的第二位置关系;所述舵轮的转轴上设置了第一齿轮,所述转向电机的转轴上设置了第二齿轮,所述编码器的转轴上设置了第三齿轮;所述第二齿轮通过齿轮传动驱动所述第一齿轮转动;所述第一齿轮通过齿轮传动驱动所述第三齿轮转动;
接收所述编码器反馈的所述舵轮转动的实时角度,并判断舵轮转动的实时角度是否达到所述目标角度;其中,所述编码器反馈的所述舵轮转动的实时角度,包括根据检测到的所述编码器转动的实时角度,以及所述第一齿轮和所述第三齿轮的传动比,确定出的所述舵轮转动的实时角度。
2.根据权利要求1所述的方法,所述方法还包括:
响应于所述实时角度未达到所述目标角度,根据所述实时角度以及所述目标角度,调整所述用于驱动所述舵轮转向的转向电机的旋转速度和旋转方向。
3.根据权利要求1所述的方法,所述第一位置关系包括平行或垂直,所述第二位置关系包括平行或垂直。
4.根据权利要求1所述的方法,所述无人智能洗地机搭载了定位传感器;所述目标角度根据为所述无人智能洗地机规划的路径确定。
5.根据权利要求1所述的方法,所述无人智能洗地机还安装了用于人工控制转向的方向盘,所述方向盘连接了方向盘编码器;所述目标角度包括所述方向盘编码器确定出的所述方向盘转动的角度。
6.根据权利要求1所述的方法,所述无人智能洗地机还安装了限位开关;
所述方法还包括:
响应于所述舵轮转动到预设的角度时,触发所述限位开关,停止驱动所述舵轮进行转向。
7.一种无人智能洗地机的转向控制系统,所述无人智能洗地机上安装了舵轮,以及与所述舵轮连接的编码器,所述舵轮的轴向与所述编码器的轴向满足预设的第一位置关系,所述系统包括:
第一接收模块,用于接收转向请求,所述转向请求包括所述舵轮转动的目标角度;所述目标角度对应数值的正负表示所述舵轮转动的方向;
控制模块,根据当前角度以及所述目标角度,以及第一齿轮和第二齿轮的传动比,计算用于驱动所述舵轮转向的转向电机的旋转速度和旋转方向,并根据所述旋转速度和所述旋转方向控制所述转向电机转动;其中,所述转向电机的轴向与所述舵轮的轴向满足预设的第二位置关系;所述舵轮的转轴上设置了第一齿轮,所述转向电机的转轴上设置了第二齿轮,所述编码器的转轴上设置了第三齿轮;所述第二齿轮通过带传动或者齿轮传动驱动所述第一齿轮转动;所述第一齿轮通过带传动或者齿轮传动驱动所述第三齿轮转动;
第二接收模块,接收所述编码器反馈的所述舵轮转动的实时角度,并判断舵轮转动的实时角度是否达到所述目标角度;其中,所述编码器反馈的所述舵轮转动的实时角度,包括根据检测到的所述编码器转动的实时角度,以及所述第一齿轮和所述第三齿轮的传动比,确定出的所述舵轮转动的实时角度。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于上海仙途智能科技有限公司,未经上海仙途智能科技有限公司许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/202111682210.X/1.html,转载请声明来源钻瓜专利网。