一种车辆传感系统及车辆自主跟随导航方法技术方案

本发明专利技术公开一种车辆传感系统及车辆自主跟随导航方法，涉及车辆导航技术领域，用于保障车辆本体的自动跟随功能及车辆本体的行车安全。车辆传感系统包括：控制器、车辆本体及与控制器通信的拉线传感器、角度传感器，角度传感器包括旋转轴及设在旋转轴上的牵引线角度拨片。其中，拉线传感器和角度传感器设置在车辆本体前端，拉线传感器的拉线穿过牵引线角度拨片与目标跟随物连接。拉线传感器用于获取车辆本体前端与目标跟随物之间的第一距离AE；角度传感器用于获取经过牵引线角度拨片及旋转轴的线段与经过拉线传感器与旋转轴的线段之间的测量角度β。车辆自主跟随导航方法控制自动导航车辆跟随目标跟随物运动。

【技术实现步骤摘要】
一种车辆传感系统及车辆自主跟随导航方法
本专利技术涉及车辆导航
，尤其涉及一种车辆传感系统及车辆自主跟随导航方法。
技术介绍
目前，视觉传感器和雷达是自主导航车辆在自主导航过程中常用的两种采集设备。作为被动式传感器的视觉传感器获取到的信息丰富，但是通过视觉传感器采集到的信息并不能直接获取车辆所处的相对位置及行驶方向等信息。一般情况下，需要通过特征提取等稀疏化手段对视觉传感器采集到的信息进行再次处理，才能获取所需信息。作为主动式传感器的雷达，其采集到的数据相对视觉传感器能更加直接的反映车辆所处的相对位置及行驶方向等信息。但是，雷达存在造价高、难以识别相似目标及受周围环境影响较大等缺点。
技术实现思路
本专利技术的目的在于提供一种车辆传感系统及车辆自主跟随导航方法，用于保障车辆本体的自动跟随功能及车辆本体的行车安全。第一方面，本专利技术提供一种车辆传感系统，包括：控制器、车辆本体及与控制器通信的拉线传感器、角度传感器，角度传感器包括旋转轴及设在旋转轴上的牵引线角度拨片。其中，拉线传感器和角度传感器设置在车辆本体前端，拉线传感器的拉线穿过牵引线角度拨片与目标跟随物连接。拉线传感器用于获取车辆本体前端与目标跟随物之间的第一距离AE；角度传感器用于获取经过牵引线角度拨片及旋转轴的线段与经过拉线传感器与旋转轴的线段之间的测量角度β。控制器用于根据第一距离AE、所述牵引线角度拨片与旋转轴之间的第二距离BC、测量角度β及拉线传感器与旋转轴之间的第三距离AB，计算目标跟随物的运动参数，并根据目标跟随物的运动参数控制车辆本体的相对运动参数。采用上述技术方案的情况下，车辆传感系统包括控制器、车辆本体及与控制器通信的拉线传感器、角度传感器。其中，拉线传感器和角度传感器间隔设置在车辆本体前端，拉线传感器的拉线穿过角度传感器与目标跟随物连接。在自动导航车辆跟随目标跟随物的过程中，拉线传感器可以获取车辆本体前端与目标跟随物之间的第一距离AE，经过牵引线角度拨片及旋转轴的线段与经过拉线传感器与旋转轴的线段之间的测量角度β。控制器根据第一距离AE、第二距离BC、测量角度β及第三距离AB，可以计算目标跟随物的相对运动参数，并根据目标跟随物的运动参数控制车辆本体的运动参数。由上述可知，该车辆传感系统仅利用拉线传感器获取的第一距离AE、牵引线角度拨片与旋转轴之间的第二距离BC、测量角度β及第三距离AB，便可以计算出目标跟随物的相对运动参数。进而根据该目标跟随物的相对运动参数，从而控制车辆本体的运动参数，使车辆本体能够自主跟随目标跟随物的运动轨迹跟随运动。与现有技术中，采用雷达及视觉传感器相互配合进行导航相比，本专利技术提供的车辆传感系统中采用的拉线传感器测量精度高、成本低、与目标跟随物交互感强、抗干扰性强，应用范围广，不受光照影响，因此能够适应复杂恶劣的环境。第二方面，本专利技术提供一种车辆自主跟随导航方法。应用上述任一项所述的车辆传感系统。车辆传感系统包括：控制器、车辆本体、拉线传感器以及角度传感器，角度传感器包括旋转轴及设在旋转轴上的牵引线角度拨片。其中，拉线传感器和角度传感器设置在车辆本体前端，拉线传感器的拉线穿过角度传感器与目标跟随物连接；该车辆自主跟随导航方法包括：接收拉线传感器发送的车辆本体前端与目标跟随物之间的第一距离AE，以及角度传感器发送的经过牵引线角度拨片及旋转轴的线段与经过拉线传感器与旋转轴的线段之间的测量角度β；根据第一距离AE、牵引线角度拨片与旋转轴之间的第二距离BC、测量角度β及拉线传感器与旋转轴之间的第三距离AB，计算目标跟随物的运动参数，并根据目标跟随物的运动参数控制车辆本体的运动参数。本专利技术第二方面提供的车辆自主跟随导航方法的有益效果与第一方面所描述的车辆传感系统的有益效果相同，此处不做赘述。附图说明此处所说明的附图用来提供对本专利技术的进一步理解，构成本专利技术的一部分，本专利技术的示意性实施例及其说明用于解释本专利技术，并不构成对本专利技术的不当限定。在附图中：图1为本专利技术实施例提供的车辆本体与目标跟随物之间的位置关系图；图2为本专利技术实施例中角度传感器的结构示意图；图3为本专利技术实施例中确定目标跟随物的运动参数的结构示意图。具体实施方式为了便于清楚描述本专利技术实施例的技术方案，在本专利技术的实施例中，采用了“第一”、“第二”等字样对功能和作用基本相同的相同项或相似项进行区分。例如，第一阈值和第二阈值仅仅是为了区分不同的阈值，并不对其先后顺序进行限定。本领域技术人员可以理解“第一”、“第二”等字样并不对数量和执行次序进行限定，并且“第一”、“第二”等字样也并不限定一定不同。需要说明的是，本专利技术中，“示例性的”或者“例如”等词用于表示作例子、例证或说明。本专利技术中被描述为“示例性的”或者“例如”的任何实施例或设计方案不应被解释为比其他实施例或设计方案更优选或更具优势。确切而言，使用“示例性的”或者“例如”等词旨在以具体方式呈现相关概念。本专利技术中，“至少一个”是指一个或者多个，“多个”是指两个或两个以上。“和/或”，描述关联对象的关联关系，表示可以存在三种关系，例如，A和/或B，可以表示：单独存在A，同时存在A和B，单独存在B的情况，其中A，B可以是单数或者复数。字符“/”一般表示前后关联对象是一种“或”的关系。“以下至少一项(个)”或其类似表达，是指的这些项中的任意组合，包括单项(个)或复数项(个)的任意组合。例如，a，b或c中的至少一项(个)，可以表示：a，b，c，a和b的结合，a和c的结合，b和c的结合，或a、b和c的结合，其中a，b，c可以是单个，也可以是多个。相关技术中，自主导航车辆的环境感知部分采用的传感器配置方式呈现出不同的形态。在一些情况下，自主导航车辆以雷达为主，视觉传感器为辅。在另一些情况下，自主导航车辆以视觉传感器为主，雷达为辅。还有一些情况下，自主导航车辆中的视觉传感器与雷达所占比例相同。一般情况下，自主导航车辆内设置有导航地图。自主导航车辆在导航地图、视觉传感器及雷达等相关传感器的共同配合下，可以自主由起始点到达终点。也就是说，自主导航车辆在导航的过程中，不需要跟随目标物的指引，自主导航车辆根据起始点及终点，便可以自主规划行驶路径。同时，通过相关传感器采集路况信息，自主导航车辆便可以实现躲避障碍物，成功到达终点。但是，在实际应用过程中，自主导航车辆有可能需要在目标跟随物3的引导下，进行自主运动。也就是说，自主导航车辆在自主导航的过程中，需要参考目标跟随物3的运动轨迹。针对上述技术问题，本专利技术实施例提供了一种车辆传感系统。图1示例出了车辆本体与目标跟随物3之间的位置关系图。图2示例出了角度传感器的结构示意图。参照图1及图2，该车辆传感系统包括：控制器、车辆本体及与控制器通信的拉线传感器1、角度传感器2。其中，拉线传感器1和角度传感器2设置在车辆本体前端，拉线传感器1的拉线穿过角度传感器2与目标跟随物3连接。在拉线传感器1及角度传感器2的配合下，控制器用于计算目标跟随物3的运动本文档来自技高网...

【技术保护点】
1.一种车辆传感系统，其特征在于，包括：控制器、车辆本体及与所述控制器通信的拉线传感器、角度传感器，所述角度传感器包括旋转轴及设在所述旋转轴上的牵引线角度拨片；其中，所述拉线传感器和所述角度传感器设置在所述车辆本体前端，所述拉线传感器的拉线穿过所述牵引线角度拨片与目标跟随物连接；/n所述拉线传感器用于获取所述车辆本体前端与所述目标跟随物之间的第一距离AE；所述牵引线角度拨片的牵引端与旋转轴之间的第二距离BC；所述角度传感器用于获取经过所述牵引线角度拨片及所述旋转轴的线段与经过所述拉线传感器与所述旋转轴的线段之间的测量角度β；/n所述控制器用于根据所述第一距离AE、所述牵引线角度拨片的牵引端与旋转轴之间的第二距离BC、所述测量角度β及所述拉线传感器与所述旋转轴之间的第三距离AB，计算所述目标跟随物的运动参数，并根据所述目标跟随物的运动参数控制所述车辆本体的相对运动参数。/n

【技术特征摘要】
1.一种车辆传感系统，其特征在于，包括：控制器、车辆本体及与所述控制器通信的拉线传感器、角度传感器，所述角度传感器包括旋转轴及设在所述旋转轴上的牵引线角度拨片；其中，所述拉线传感器和所述角度传感器设置在所述车辆本体前端，所述拉线传感器的拉线穿过所述牵引线角度拨片与目标跟随物连接；
所述拉线传感器用于获取所述车辆本体前端与所述目标跟随物之间的第一距离AE；所述牵引线角度拨片的牵引端与旋转轴之间的第二距离BC；所述角度传感器用于获取经过所述牵引线角度拨片及所述旋转轴的线段与经过所述拉线传感器与所述旋转轴的线段之间的测量角度β；
所述控制器用于根据所述第一距离AE、所述牵引线角度拨片的牵引端与旋转轴之间的第二距离BC、所述测量角度β及所述拉线传感器与所述旋转轴之间的第三距离AB，计算所述目标跟随物的运动参数，并根据所述目标跟随物的运动参数控制所述车辆本体的相对运动参数。


2.根据权利要求1所述的车辆传感系统，其特征在于，所述目标跟随物的相对运动参数包括：所述目标跟随物与所述车辆本体之间在水平面上的垂直距离d、经过所述拉线传感器及所述目标跟随物的线段与经过所述拉线传感器及所述旋转轴的线段之间的夹角α、所述垂直距离d的变化速度Di及所述夹角α的变化速度Ri。


3.根据权利要求2所述的车辆传感系统，其特征在于，所述垂直距离d满足：
d＝AE×cosα。


4.根据权利要求2所述的车辆传感系统，其特征在于，所述夹角α满足：



其中，距离为DB的线段为距离为AB的线段的延伸线段，且所述距离为DC的线段与所述距离为DB的线段垂直；
当夹角α＝0，所述车辆本体的前进方向与所述目标跟随物的前进方向一致；当夹角α＞0，所述目标跟随物位于所述车辆本体的左侧；当夹角α＜0，所述目标跟随物位于所述车辆本体的右侧。

【专利技术属性】
技术研发人员：王亮，符志强，朱琳，伍朝辉，吕子一，李贤统，徐萍，
申请(专利权)人：交通运输部科学研究院，
类型：发明
国别省市：北京;11