智能无人装车系统的智能小车及其位移控制方法.pdf

(19)中华人民共和国国家知识产权局(12)发明专利申请(10)申请公布号CN110282454A(43)申请公布日2019.09.27(21)申请号201910739262.2(22)申请日2019.08.12(71)申请人龙合智能装备制造有限公司地址364101福建省龙岩市永定工业园区04#1层(72)发明人杨静杨林海杨小龙(74)专利代理机构北京云科知识产权代理事务所(特殊普通合伙)11483代理人张飙(51)Int.Cl.B65G67/04(2006.01)B65G35/00(2006.01)B65G43/08(2006.01)B65G57/00(2006.01)权利要求书3页说明书5页附图2页(54)发明名称智能无人装车系统的智能小车及其位移控制方法(57)摘要本发明涉及智能无人装车系统的智能小车及其位移控制方法，应用于垛装产品智能无人装车系统，所述智能小车底部设置有舵轮、辅助万向轮、第一从动轮组和第二从动轮组，所述智能小车底部左右两端分别设置有第三测距传感器和第四测距传感器，所述舵轮驱动模块可以将舵轮的中心转轴在水平面内进行旋转从而改变舵轮的前进方向，通过行进过程中监测第三测距传感器和第四测距传感器的测距值差异，判断是否发生倾斜，避免发生倾翻。CN110282454ACN110282454A权利要求书1/3页1.一种智能无人装车系统的智能小车，应用于垛装产品智能无人装车系统，所述智能无人装车系统采用智能小车进行码垛的搬运，将码垛货物送入货车车箱内，所述智能无人装车系统设置有控制模块和装车平台，所述智能小车在装车平台与货车车箱之间往返，所述装车平台的右侧边缘设置有右侧垂直挡板，所述智能小车设置有码垛承载部、斜板、尾板和背板部，所述码垛承载部的右侧壁上设置有第一测距传感器，所述背板部的右侧壁上设置有第二测距传感器，所述第一测距传感器和第二测距传感器的安装位置高度相等且小于右侧垂直挡板的高度，所述控制模块设置有计算单元，所述装车平台的后侧边缘设置有后侧垂直挡板，其特征在于，所述斜板连接在所述码垛承载部的前端，所述斜板为楔形折弯板，所述斜板的楔形折弯内侧左右两端分别设置有第三测距传感器和第四测距传感器，所述尾板连接在所述背板部后侧，所述尾板下表面设置有第五测距传感器，第五测距传感器的安装高度小于后侧垂直挡板的高度，所述智能小车底部设置有舵轮、辅助万向轮、第一从动轮组和第二从动轮组，所述舵轮设置于背板部下方，所述舵轮设置于所述智能小车的中心对称线上，所述第一从动轮组和第二从动轮组设置于码垛承载部下方并靠近斜板，所述第一从动轮组和第二从动轮组对称地设置于所述智能小车中心对称线左右两侧，所述舵轮设置有驱动模块，所述舵轮驱动模块可以将舵轮的中心转轴在水平面内进行旋转从而改变舵轮的前进方向。2.根据权利要求1所述智能无人装车系统的智能小车，其特征在于，所述辅助万向轮设置于舵轮与第一从动轮组和第二从动轮组之间，所述第一测距传感器、第二测距传感器、第五测距传感器、第三测距传感器和第四测距传感器的输出端口均与控制模块的输入端口相连接，第三测距传感器和第四测距传感器对称地设置于所述智能小车中心对称线两侧。3.根据权利要求1所述智能无人装车系统的智能小车，其特征在于，所述第三测距传感器和第四测距传感器朝向装车平台表面，所述第五测距传感器朝向所述后侧垂直挡板，所述控制模块实时接收第三测距传感器、第四测距传感器、第五测距传感器、第一测距传感器和第二测距传感器的测距值。4.智能无人装车系统的智能小车位移控制方法，应用于垛装产品智能无人装车系统，其特征在于，所述方法包括：S101：确定智能小车的目标位置参数和目前位置参数；S102：求解特征参数；S103：设定参数，智能小车在舵轮驱动下移动；S104：判断第三测距传感器测距值与第四测距传感器测距值之差是否小于阈值，若是，则进入S105，若否，则返回S101；S105：判断是否到达目标位置，若是，则结束，若否，则返回S101。5.根据权利要求4所述智能无人装车系统的智能小车位移控制方法，其特征在于，确定智能小车的目标位置参数和目前位置参数，还包括：所述目标位置参数和目前位置参数均采用三个参数进行界定，三个参数的表示符号及其定义，分别为：X：第一测距传感器的测距值；Y：第五测距传感器的测距值；W：其定义为W＝arcsin{[(第二测距传感器的测距值)-(第一测距传感器的测距值)]/2CN110282454A权利要求书2/3页(第一测距传感器与第二测距传感器的间距)}；所述目标位置参数表示为(Xa,Ya,Wa),所述目前位置参数表示为(Xb,Yb,Wb),所述控制模块发送第一测距传感器、第二测距传感器与第五测距传感器的测距值给计算单元，计算单元计算目前位置参数。6.根据权利要求4所述智能无人装车系统的智能小