欢迎来到利索能及~ 联系电话:18621327849
利索能及
我要发布
收藏
专利号: 2017105662242
申请人: 台州智奥通信设备有限公司
专利类型:发明专利
专利状态:已下证
专利领域: 控制;调节
更新日期:2024-10-29
缴费截止日期: 暂无
联系人

摘要:

权利要求书:

1.一种基于超声波测距的AGV小车导航方法,其特征在于,包括步骤:S1.车载超声波模块(1)实时测量其与倾斜设置的导航挡板的垂直距离,并将测量结果发送至CPU模块(2);

S2.所述CPU模块(2)根据所述测量结果计算所述车载超声波模块(1)与导航挡板的水平偏移距离;

S3.所述CPU模块(2)根据所述水平偏移距离计算方向校正数据,并将所述方向校正数据发送至驱动模块(3);

S4.驱动模块(3)根据所述方向校正数据调整AGV小车行驶方向;

步骤S2中,车载超声波模块(1)与导航挡板的水平偏移距离计算公式为:X=(y-h)/tanθ;

其中,AGV小车预设轨迹方向顺时针90度方向为正方向;

X为车载超声波模块(1)与导航挡板的水平偏移距离;

y为车载超声波模块(1)与导航挡板的实时垂直距离;

h为AGV小车沿预定轨迹行驶时车载超声波模块(1)与导航挡板的垂直距离;

θ为多个连续的导航挡板与水平方向的夹角;

AGV小车的全部预定轨迹上方倾斜设置有连续的导航挡板。

2.如权利要求1所述的一种基于超声波测距的AGV小车导航方法,其特征在于,所述导航挡板水平高度相同,且倾斜角相同。

3.如权利要求2所述的一种基于超声波测距的AGV小车导航方法,其特征在于,步骤S3之前,包括:设置预设偏移范围;

当水平偏移距离属于预设偏移范围内时,不需要进行方向校正;

当水平偏移距离超出所述预设偏移范围时,则需要进行方向校正。

4.如权利要求3所述的一种基于超声波测距的AGV小车导航方法,其特征在于,步骤S3之前,包括:判断所述水平偏移距离x是否超出预设偏移范围;

若是,则进入步骤S3。

5.如权利要求4所述的一种基于超声波测距的AGV小车导航方法,其特征在于,在步骤S4中,驱动模块(3)根据所述方向校正数据校正行驶方向,直到所述AGV小车的实时水平偏移距离属于预设偏移范围内。

6.一种基于超声波测距的AGV小车导航系统,包括AGV小车及多个导航挡板,其特征在于,所述AGV小车包括:车载超声波模块(1)、CPU模块(2)及驱动模块(3);

所述车载超声波模块(1)用于实时测量其与倾斜设置的导航挡板的垂直距离,并将测量结果发送至CPU模块(2);

所述CPU模块(2)用于根据所述测量结果计算所述车载超声波模块(1)与导航挡板的水平偏移距离;所述CPU模块(2)还用于根据所述水平偏移距离计算方向校正数据,并将所述方向校正数据发送至驱动模块(3);

所述驱动模块(3)用于根据所述方向校正数据调整AGV小车行驶方向;

所述多个导航挡板倾斜设置于AGV小车的全部预定轨迹上方;

车载超声波模块(1)与导航挡板的水平偏移距离计算公式为:X=(y-h)/tanθ;

其中,AGV小车预设轨迹方向顺时针90度方向为正方向;

X为车载超声波模块(1)与导航挡板的水平偏移距离;

y为车载超声波模块(1)与导航挡板的实时垂直距离;

h为AGV小车沿预定轨迹行驶时车载超声波模块(1)与导航挡板的垂直距离;

θ为多个连续的导航挡板与水平方向的夹角。

7.如权利要求6所述的一种基于超声波测距的AGV小车导航系统,其特征在于,所述CPU模块(2)还用于判断所述计算的水平偏移距离是否超出预设偏移范围;若是,则根据所述水平偏移距离计算方向校正数据。

8.如权利要求6所述的一种基于超声波测距的AGV小车导航系统,其特征在于,所述多个导航挡板水平高度相同,且倾斜角相同。