拖挂式移动机器人平行泊车方法技术

本发明专利技术的拖挂式移动机器人平行泊车方法，包括：a)定义初始和终点位形；b)设定参考路径为、、；c)建立路径下的运动学模型；d)建立路径下的运动学模型；e)求解路径，计算从点位形正向开始的n束曲线参考路径；f)求解路径，计算从点位形反向开始的n束曲线参考路径；g)找出相切或近似相切的交点；h)确定泊车路径；i)控制泊车，控制拖挂式移动机器人进行泊车。本发明专利技术的平行泊车方法，在初始位形和终点位形已知的情况下，可自动计算出最佳的泊车路径，在模糊控制器的作用下可实现自动泊车，为现有拖挂式机器人的自动平行泊车奠定了理论基础。

【技术实现步骤摘要】

本专利技术涉及一种，更具体的说，尤其涉及一种首先计算出泊车路径再利用模糊控制器控制泊车的。
技术介绍
拖挂式移动机器人(Tractor-trailer Mobile Robot,TTMR)是一种较为特殊的移动机器人，它由位于最前端的牵引车(tractor)和由之拖动的多个被动的拖车(trailer)组成，牵引车执行转向和驱动功能，而拖车跟随牵引车运动。拖挂式移动机器人一方面具有移动机器人的运动能力，另一方面可以拓展移动机器人的其它功能。例如清洁机器人，可以在移动机器人后拖挂一个清扫和收集垃圾的卡车，从而降低成本，提高效率；另外，救援机器人可以通过拖挂增加其运输能力，同时拖车节数也可以灵活改变，以便运输大量物体。目前，拖挂式移动机器人的研究对象主要为室内服务机器人，如清洁机器人，救援机器人，在工厂仓库、机场用于运输货物、搬运行李、货物中转等任务的运输机器人。国际机器人技术联合会对服务机器人有一个初步的定义:服务机器人是一种半自主或全自主工作的机器人，它能完成有益于人类的服务工作，但不包括从事生产的设备。从广义上可以认为服务机器人是指除工业机器人之外的各种机器人，主要应用于服务业，如水下机器人、清洁机器人、救援机器人等。目前，服务机器人正在以飞快的速度发展壮大。根据IFR的调查，1998年底，世界服务机器人的总数(不包括真空吸尘机器人)估计为最少5000台，而到2009年底，约有76，600台服务机器人在世界范围内得到应用，并且预计家用机器人(domestic robot)将成为服务机器人的主要支柱。平行泊车问题来源于倒车问题，1989年，美国斯坦福大学的Widrow教授在针对非线性多变量系统的最优控制问题的研究中提出了倒车问题]。由于系统存在非完整约束，非完整系统的倒车问题以及平行泊车问题具有很大的挑战性，已经成为控制领域研究的重要问题。国内外学者对于一般轮式移动机器人的倒车问题的研究已有很多，如Widrow提出的基于神经网络的控制方法，Kosko以及Freeman等人提出的模糊控制方法,Tanaka基于线性不等式的控制设计方法。但对于拖挂式移动机器人的倒车问题的研究相对较少。Andri Riid等人对类似系统的倒车问题提出一种分层模糊控制方法。平行泊车问题要求控制拖挂式移动机器人从初始位形运动到与初始位形平行的终点位形。由于反向运动时拖车子系统不稳定，拖挂式移动机器人的反向平行泊车问题更为复杂和困难。
技术实现思路
本专利技术为了克服上述技术问题的缺点，提供了 一种。本专利技术的，拖挂式移动机器人包括牵引车和拖车，牵引车与拖车之间通过链接点相连接，链接点处设置有用于测量拖车的车体纵向线相对于牵引车的车体纵向线转动角度的角度传感器牵引车由后轮驱动、前轮转向，牵引车前转向轮的转向角速度为牵引车的纵向速度力> 且车轮与地面无滑动；牵引车驱动轮与转向轮之间的距离为拖车的轮轴中点到链接点的距离为毛，连接轴的长度为厶；牵引车的左、右驱动轮可分别进行驱动，并通过左、右驱动轮的不同转速实现转向； 定义为坐标系ar/中牵引车和拖车的位形，2 =1时表示牵引车的位形d =2时表示拖车的位形；为牵引车后轮轴中心点的坐标，为拖车轮轴中线点的坐标力方位角，表示车体纵向线相对于坐标系r轴正向所旋转的角度《力牵引车的转向角，表示牵引车转向轮与车体纵向线之间的夹角巧；牵引车可获取自身车体纵向线相对于坐标手、I轴正向所旋转的角度；总、式为牵引车左、右驱动轮的速度； 其特征在于，所述平行泊车方法通过以下步骤来实现: a).定义初始和终点位形,设初始位形为..X1 =O h =O, &1= &2 =0°，记为O点；终点位形力I =0，? = D ,迗=^ =0。，记为G点，则拖挂式机器人要实现距离力L的平行泊车；b).设定参考路径，设拖挂式机器人从O至G点实现平行泊车依次经过直线路径曲线路径颂、曲线路径βσ，路径a?、SQ、QG中牵引车的转向角分别为常值<%、％、％，且Ψο =0° ;设2点拖挂式机器人的位形为A U =O, &1 = 4 =0° ；c).建立βο路径下的运动学模型，建立如动态方程组(I)所示的路径βσ下拖挂式移动机器人的运动学模型:本文档来自技高网...

【技术保护点】
一种拖挂式移动机器人平行泊车方法，拖挂式移动机器人包括牵引车和拖车，牵引车与拖车之间通过链接点相连接，链接点处设置有用于测量拖车的车体纵向线相对于牵引车的车体纵向线转动角度的角度传感器；牵引车由后轮驱动、前轮转向，牵引车前转向轮的转向角速度为，牵引车的纵向速度为，且车轮与地面无滑动；牵引车驱动轮与转向轮之间的距离为，拖车的轮轴中点到链接点的距离为，连接轴的长度为；牵引车的左、右驱动轮可分别进行驱动，并通过左、右驱动轮的不同转速实现转向；定义为坐标系中牵引车和拖车的位形，=1时表示牵引车的位形，=2时表示拖车的位形；为牵引车后轮轴中心点的坐标，为拖车轮轴中线点的坐标；为方位角，表示车体纵向线相对于坐标系轴正向所旋转的角度；为牵引车的转向角，表示牵引车转向轮与车体纵向线之间的夹角；牵引车可获取自身车体纵向线相对于坐标系轴正向所旋转的角度；、为牵引车左、右驱动轮的速度；其特征在于，所述平行泊车方法通过以下步骤来实现：a).定义初始和终点位形，设初始位形为：=0，=0，==0°，记为点；终点位形为=0，=，==0°，记为点，则拖挂式机器人要实现距离为的平行泊车；b).设定参考路径，设拖挂式机器人从至点实现平行泊车依次经过直线路径、曲线路径、曲线路径，路径、、中牵引车的转向角分别为常值、、，且=0°；设点拖挂式机器人的位形为=，=0，==0°；c).建立路径下的运动学模型，建立如动态方程组（1）所示的路径下拖挂式移动机器人的运动学模型：（1）d).建立路径下的运动学模型，首先设计一个辅助的虚拟牵引车，在平面坐标系中虚拟牵引车与实际牵引车相对于拖车的车轮轴线是对称的，以便将反向运动转换为虚拟牵引车的正向运动；然后建立如动态方程组（2）所示的路径下虚拟拖挂式移动机器人的运动学模型：（2）其中，=‑；、分别为虚拟牵引车及对应挂车的位形；e).求解路径，将终点的位形=0、=、==0，车体参数、、以及牵引车的纵向速度代入拖挂式移动机器人的动态方程组（1）中，并在满足约束条件＜的情况下，求出转向角==‑0.01*，=0,1,2,…,，且≤时，计算从点位形正向开始的n束曲线参考路径；f).求解路径，将点的位形=、=0、==0，车体参数、、以及牵引车的纵向速度代入虚拟拖挂式移动机器人的动态方程组（2）中，并在满足约束条件＜的情况下，求出转向角==0.01*，=0,1,2,…,，且≤时，计算从点位形反向开始的n束曲线参考路径；g).找出相切或近似相切的交点，定义位形∈,位形∈为段曲线路径和段曲线路径上的两个邻近位形，如果满足如下约束条件：≤，且≤（3）则认为位形、满足交点相切或近似相切条件，交点或；h).确定泊车路径，根据步骤g)求出的交点，确定出拖挂式移动机器人平行泊车时的直线路径、曲线路径和曲线路径，以及路径下的转向角、路径下的转向角；i).控制泊车，根据步骤h)中确定的泊车路径，控制拖挂式移动机器人进行泊车。...

【技术特征摘要】
1.一种拖挂式移动机器人平行泊车方法，拖挂式移动机器人包括牵引车和拖车，牵引车与拖车之间通过链接点相连接，链接点处设置有用于测量拖车的车体纵向线相对于牵引车的车体纵向线转动角度的角度传感器；牵引车由后轮驱动、前轮转向，牵引车前转向轮的转向角速度为牵引车的纵向速度力' 且车轮与地面无滑动；牵引车驱动轮与转向轮之间的距离为4，拖车的轮轴中点到链接点的距离为4，连接轴的长度为4牵引车的左、右驱动轮可分别进行驱动，并通过左、右驱动轮的不同转速实现转向； 定义)为坐标系OJO7中牵引车和拖车的位形，i =1时表示牵引车的位形，τ =2时表示拖车的位形；为牵引车后轮轴中心点的坐标，为拖车轮轴中线点的坐标；肖为方位角，表示车体纵向线相对于坐标系X轴正向所旋转的角度；供为牵引车的转向角，表示牵引车转向轮与车体纵向线之间的夹角；牵引车可获取自身车体纵向线相对于坐标系尤轴正向所旋转的角度巧；A?、尽为牵引车左、右驱动轮的速度； 其特征在于，所述平行泊车方法通过以下步骤来实现: a).定义初始和终点位形,设初始位形为:?=0 ...

【专利技术属性】
技术研发人员：程金，张勇，王中华，
申请(专利权)人：济南大学，
类型：发明
国别省市：山东;37