详情

原文传递智能无人装车系统的智能小车及其位移控制方法

专利名称：	智能无人装车系统的智能小车及其位移控制方法
摘要：	本发明涉及智能无人装车系统的智能小车及其位移控制方法，应用于垛装产品智能无人装车系统，所述智能小车底部设置有舵轮、辅助万向轮、第一从动轮组和第二从动轮组，所述智能小车底部左右两端分别设置有第三测距传感器和第四测距传感器，所述舵轮驱动模块可以将舵轮的中心转轴在水平面内进行旋转从而改变舵轮的前进方向，通过行进过程中监测第三测距传感器和第四测距传感器的测距值差异，判断是否发生倾斜，避免发生倾翻。
专利类型：	发明专利
国家地区组织代码：	福建;35
申请人：	龙合智能装备制造有限公司
发明人：	杨静;杨林海;杨小龙
专利状态：	有效
申请日期：	2019-08-12T00:00:00+0800
发布日期：	2019-09-27T00:00:00+0800
申请号：	CN201910739262.2
公开号：	CN110282454A
代理机构：	北京云科知识产权代理事务所(特殊普通合伙)
代理人：	张飙
分类号：	B65G67/04(2006.01);B;B65;B65G;B65G67
申请人地址：	364101 福建省龙岩市永定工业园区04#1层
主权项：	1.一种智能无人装车系统的智能小车，应用于垛装产品智能无人装车系统，所述智能无人装车系统采用智能小车进行码垛的搬运，将码垛货物送入货车车箱内，所述智能无人装车系统设置有控制模块和装车平台，所述智能小车在装车平台与货车车箱之间往返，所述装车平台的右侧边缘设置有右侧垂直挡板，所述智能小车设置有码垛承载部、斜板、尾板和背板部，所述码垛承载部的右侧壁上设置有第一测距传感器，所述背板部的右侧壁上设置有第二测距传感器，所述第一测距传感器和第二测距传感器的安装位置高度相等且小于右侧垂直挡板的高度，所述控制模块设置有计算单元，所述装车平台的后侧边缘设置有后侧垂直挡板，其特征在于，所述斜板连接在所述码垛承载部的前端，所述斜板为楔形折弯板，所述斜板的楔形折弯内侧左右两端分别设置有第三测距传感器和第四测距传感器，所述尾板连接在所述背板部后侧，所述尾板下表面设置有第五测距传感器，第五测距传感器的安装高度小于后侧垂直挡板的高度，所述智能小车底部设置有舵轮、辅助万向轮、第一从动轮组和第二从动轮组，所述舵轮设置于背板部下方，所述舵轮设置于所述智能小车的中心对称线上，所述第一从动轮组和第二从动轮组设置于码垛承载部下方并靠近斜板，所述第一从动轮组和第二从动轮组对称地设置于所述智能小车中心对称线左右两侧，所述舵轮设置有驱动模块，所述舵轮驱动模块可以将舵轮的中心转轴在水平面内进行旋转从而改变舵轮的前进方向。 2.根据权利要求1所述智能无人装车系统的智能小车，其特征在于，所述辅助万向轮设置于舵轮与第一从动轮组和第二从动轮组之间，所述第一测距传感器、第二测距传感器、第五测距传感器、第三测距传感器和第四测距传感器的输出端口均与控制模块的输入端口相连接，第三测距传感器和第四测距传感器对称地设置于所述智能小车中心对称线两侧。 3.根据权利要求1所述智能无人装车系统的智能小车，其特征在于，所述第三测距传感器和第四测距传感器朝向装车平台表面，所述第五测距传感器朝向所述后侧垂直挡板，所述控制模块实时接收第三测距传感器、第四测距传感器、第五测距传感器、第一测距传感器和第二测距传感器的测距值。 4.智能无人装车系统的智能小车位移控制方法，应用于垛装产品智能无人装车系统，其特征在于，所述方法包括： S101：确定智能小车的目标位置参数和目前位置参数； S102：求解特征参数； S103：设定参数，智能小车在舵轮驱动下移动； S104：判断第三测距传感器测距值与第四测距传感器测距值之差是否小于阈值，若是，则进入S105，若否，则返回S101； S105：判断是否到达目标位置，若是，则结束，若否，则返回S101。 5.根据权利要求4所述智能无人装车系统的智能小车位移控制方法，其特征在于，确定智能小车的目标位置参数和目前位置参数，还包括：所述目标位置参数和目前位置参数均采用三个参数进行界定，三个参数的表示符号及其定义，分别为： X：第一测距传感器的测距值； Y：第五测距传感器的测距值； W：其定义为W＝arcsin{[(第二测距传感器的测距值)-(第一测距传感器的测距值)]/(第一测距传感器与第二测距传感器的间距)}；所述目标位置参数表示为(Xa,Ya,Wa), 所述目前位置参数表示为(Xb,Yb,Wb), 所述控制模块发送第一测距传感器、第二测距传感器与第五测距传感器的测距值给计算单元，计算单元计算目前位置参数。 6.根据权利要求4所述智能无人装车系统的智能小车位移控制方法，其特征在于，求解特征参数，还包括: 所述特征参数定义为： P＝V·Δt 其中，V为智能小车的行进线速度，Δt为智能小车的行进时间；所述特征参数通过下列方程组进行求解： Xa＝Xb-L/(tanA·sinWb)+L/[tanA·sin(Wb+M)] Ya＝Yb+L/(tanA·cosWb)-L/[tanA·cos(Wb+M)] Wa＝Wb+M M＝P·sinA/L 其中，A为舵轮偏转角度，L为舵轮对称中心线与第一从动轮组合对称中心线之间间距在水平面内的投影长度，计算单元通过求解上述方程组，获得特征参数P＝V·Δt的数值。 7.根据权利要求4所述智能无人装车系统的智能小车位移控制方法，其特征在于，设定参数，智能小车在舵轮驱动下移动，还包括：控制模块设定舵轮偏转角度为A，根据特征参数P＝V·Δt的数值，控制模块优先V为智能小车的最大行驶线速度，控制模块将根据特征参数P＝V·Δt计算所得Δt作为计时总时长开始倒计时，控制模块发送控制指令给舵轮，舵轮开始工作，带动智能小车移动。 8.根据权利要求4所述智能无人装车系统的智能小车位移控制方法，其特征在于，判断第三测距传感器测距值与第四测距传感器测距值之差是否小于阈值，还包括：所述阈值存储在控制模块内，第三测距传感器测距值与第四测距传感器测距值之差小于阈值，表明智能小车运行平稳，未发生倾斜，不会翻车；第三测距传感器测距值与第四测距传感器测距值之差达到阈值，表明智能小车发生倾斜，有翻车风险，舵轮立即停止工作，返回步骤S101重新开始。 9.根据权利要求4所述智能无人装车系统的智能小车位移控制方法，其特征在于，判断是否到达目标位置，还包括：所述控制模块发送第一测距传感器、第二测距传感器与第五测距传感器的测距值给计算单元，计算单元计算目前位置参数，并分别计算目前位置参数与目标位置参数之间的差异ΔX、ΔY、ΔW是否均分别在误差允许范围内： ΔX＝Xb-Xa, ΔY＝Yb-Ya, ΔW＝Wb-Wa, 若ΔX、ΔY、ΔW均分别在误差允许范围内，则结束，否则返回S101。
所属类别：	发明专利