CN112848822B - 一种测量挂车车头与货箱夹角的拉线装置及其测量方法 - Google Patents
一种测量挂车车头与货箱夹角的拉线装置及其测量方法 Download PDFInfo
- Publication number
- CN112848822B CN112848822B CN202110214758.5A CN202110214758A CN112848822B CN 112848822 B CN112848822 B CN 112848822B CN 202110214758 A CN202110214758 A CN 202110214758A CN 112848822 B CN112848822 B CN 112848822B
- Authority
- CN
- China
- Prior art keywords
- wire
- container
- motor
- stay wire
- stay
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60D—VEHICLE CONNECTIONS
- B60D1/00—Traction couplings; Hitches; Draw-gear; Towing devices
- B60D1/24—Traction couplings; Hitches; Draw-gear; Towing devices characterised by arrangements for particular functions
- B60D1/248—Traction couplings; Hitches; Draw-gear; Towing devices characterised by arrangements for particular functions for measuring, indicating or displaying the weight
Abstract
本发明涉及一种测量挂车车头与货箱夹角的拉线装置及其测量方法,拉线装置包括车头牵引座、第一拉线电机、第二拉线电机、货箱固定座及大梁、货箱连接支架、控制器;第一拉线电机和第二拉线电机左右对称安装在车头牵引座尾部;货箱固定座及大梁前部中心与牵引座轴心相连接;两个货箱连接支架对称布置,其上方与货箱固定座及大梁后部相连接;两个货箱连接支架下部对称设有拉线点,与第一拉线电机和第二拉线电机伸出的拉线分别连接;第一拉线电机和第二拉线电机上拉线长度传感器测量并向控制器传输相应拉线电机的拉线长度变化量,控制器根据几何关系计算挂车车头与货箱的夹角。本发明可以单独测量挂车车头与货箱的水平夹角且可避免货箱俯仰角度干扰。
Description
技术领域
本发明涉及一种测量车头与车厢夹角的装置及方法,尤其涉及一种测量挂车车头与货箱夹角的拉线装置及其测量方法。
背景技术
我国自动驾驶技术正在快速发展,挂车的编队驾驶是自动驾驶中一种重要的技术。在挂车的编队行驶中需要获取后车与前车车头、货箱之间的相对位置关系,用于编队驾驶中更进一步的车辆轨迹控制以及横纵向控制。通常,货箱安装有相对定位装置,此时需要有另一个装置协同测量车头位置,其中一种典型的方法为测量车头与货箱夹角,根据车头与货箱之间的几何关系计算车头实际位置。但目前并没有直接测量挂车车头、货箱夹角的装置,常采用其他传感器组合进行测量,成本较高,方案较为复杂。
发明内容
为解决上述现有技术中成本较高、方案较为复杂的问题,本发明提供一种测量挂车车头与货箱夹角的拉线装置及其测量方法,其能单独测量挂车车头与货箱的水平夹角。
本发明的具体技术方案如下:
一种测量挂车车头与货箱夹角的拉线装置,其特征在于,所述拉线装置包括车头牵引座、第一拉线电机、第二拉线电机、货箱固定座及大梁、货箱连接支架、控制器;
所述第一拉线电机和所述第二拉线电机以所述车头牵引座上的牵引座轴心为中心左右对称安装在所述车头牵引座尾部;
所述货箱固定座及大梁前部中心与所述牵引座轴心相连接;货箱能够围绕所述牵引座轴心水平旋转及上下摆动;
两个所述货箱连接支架以所述牵引座轴心为中心对称布置,其上方与所述货箱固定座及大梁后部相连接;两个所述货箱连接支架下部对称设有拉线点,通过所述拉线点与所述第一拉线电机和所述第二拉线电机伸出的拉线分别连接;
所述第一拉线电机和所述第二拉线电机上分别固接拉线长度传感器,所述拉线长度传感器与所述控制器数据相连,所述拉线长度传感器测量并向所述控制器传输相应拉线电机的所述拉线长度变化量,所述控制器根据几何关系计算挂车车头与货箱的夹角。
进一步地,所述拉线装置还包括拉线电机安装支架,所述车头牵引座底部为安装板,所述第一拉线电机和所述第二拉线电机通过所述拉线电机安装支架安装在所述安装板上。
进一步地,所述第一拉线电机和所述第二拉线电机通过所述拉线电机安装支架与所述安装板螺栓连接。
本发明还公开了一种利用拉线装置测量挂车车头与货箱夹角的方法,其特征在于,所述方法包括如下步骤:
S1、标定几何关系;
测量前,预先标定拉线原始长度D1,D2,标定牵引座轴心、第一拉线电机和第二拉线电机、拉线点的相对位置,标定坐标原点为牵引座轴心O(0,0,0),第一拉线电机 E1(Ex1,Ey1,Ez1)、第二拉线电机E2(Ex2,Ey2,Ez2),两个拉线点位置 P1(Px1,Py1,Pz1)、P2(Px2,Py2,Pz2);牵引座轴心O与拉线点距离 OP1,OP2长度,记为L1,L2;
S2、求解拉线点位置;
测量时,拉线长度传感器检测拉线长度变化量d1,d2,并传递给控制器;求解新拉线点P′1,P′2点坐标 P′1(Px′1,Py′1,Pz′1),P′2(Px′2,Py′2,Pz′2);
S3、求解夹角大小;
定义挂车车头与货箱初始位置为夹角0°,实际挂车车头与货箱水平夹角大小可采用如下公式计算:
S4、根据长度变化量确定货箱偏转方向;
实际旋转方向根据d1,d2大小关系确定,货箱向d小的一侧旋转。
进一步地,在步骤S2中,求解新拉线点P′1,P′2点坐标的方程为:
该方程组展开为
解得新拉线点P′1,P′2点坐标P′1(Px′1,Py′1,Pz′1),P′2(Px′2,Py′2,Pz′2)。
本发明的有益效果:
本发明可通过简单的装置单独测量挂车车头与货箱的水平夹角,且可避免货箱俯仰角度干扰,该拉线装置成本较低,夹角的测量方法简单快捷。而且本发明中用于角度计算的公式,考虑了货箱上下摆动带来的长度变化,可以避免货箱上下摆动带来的误差,求解出货箱水平方向的夹角。
附图说明
图1为本发明测量挂车车头与货箱夹角的拉线装置结构示意图;
图2为本发明中拉线长度传感器安装位置示意图;
图3为本发明拉线装置与货箱连接侧面示意图;
图4为本发明中拉线装置与货箱连接侧面放大图;
图5为本发明中建立坐标系及标定长度示意图;
图6为本发明测量挂车车头与货箱夹角方法流程图。
其中:1-车头牵引座、1.1-牵引座轴心、1.2-安装板、2-第一拉线电机、3-第二拉线电机、4-拉线电机安装支架、5-货箱固定座及大梁、6-货箱连接支架、6.1-拉线点。
具体实施方式
为了使本领域的技术人员更好地理解本申请的技术方案,以下将结合附图及实施例对本发明做进一步详细说明。
本申请文件中的上、下、左、右、前和后等方位用语是基于附图所示的位置关系而建立的。附图不同,则相应的位置关系也有可能随之发生变化,故不能以此理解为对保护范围的限定。
本发明中,术语“安装”、“相连”、“相接”、“连接”、“固定”等应做广义理解,例如,可以是固定连接,也可以是可拆卸连接,也可以是一体地连接,也可以是机械连接,也可以是电连接或可以相互通信,也可以是直接连接,也可以是通过中间媒介间接连接,可以是两个元器件内部的联通,也可以是两个元器件的相互作用关系。对于本领域的普通技术人员而言,可以根据具体情况理解上述术语在本发明中的具体含义。
本实施例记载了一种测量挂车车头与货箱夹角的拉线装置及其测量方法,通过拉线装置实现挂车车头与货箱之间的相应测量,进而计算挂车车头与货箱的夹角。
如图1至图4所示,该拉线装置包括车头牵引座1、第一拉线电机2、第二拉线电机3、拉线电机安装支架4、货箱固定座及大梁5、货箱连接支架6、控制器,在车头牵引座1的尾部,第一拉线电机2 和第二拉线电机3通过螺栓固定在拉线电机安装支架4上,且第一拉线电机2和第二拉线电机3以牵引座轴心1.1为中心左右对称布置。拉线电机安装支架4螺栓安装在车头牵引座1底部的安装板1.2上。货箱固定座及大梁5前部中心与牵引座轴心1.1相连接,货箱可围绕牵引座轴心1.1水平旋转,并可上下摆动。货箱连接支架6上方与货箱固定座及大梁5后部螺栓连接,且两个货箱连接支架6以牵引座轴心1.1为中心在货箱固定座及大梁5后部对称分布。第一拉线电机2 和第二拉线电机3伸出的拉线与两个货箱连接支架6下部对称设置的拉线点6.1分别连接。
当货箱左右转动以及上下摆动时,第一拉线电机2和第二拉线电机3的拉线可伸缩。在第一拉线电机2和第二拉线电机3上螺栓固接拉线长度传感器(如图2所示),拉线长度传感器与控制器通过数据线相连,拉线长度传感器可测量相应拉线电机的拉线长度变化量,并通过数据线发送给控制器。控制器通过挂车车头与货箱之间的几何关系计算挂车车头与货箱水平方向的夹角。
车辆运行时货箱可与车头形成一定夹角,同时存在俯仰摆动,拉动拉线电机拉线,控制器读取拉线电机长度变化数据,并根据算法计算挂车车头与货箱夹角。如图5和图6所示,步骤如下:
步骤一:标定几何关系
在测量前,预先标定拉线原始长度D1,D2,标定牵引座轴心1.1、第一拉线电机2和第二拉线电机3、拉线点的相对位置,并根据如图 5示出的直角坐标系中标记坐标点位置,标定坐标原点为牵引座轴心 1.1 O(0,0,0),第一拉线电机2和第二拉线电机3位置分别为 E1(Ex1,Ey1,Ez1)、E2(Ex2,Ey2,Ez2),拉线点位置 P1(Px1,Py1,Pz1)、P2(Px2,Py2,Pz2)。
由于第一拉线电机2和第二拉线电机3对称安装,
Ex1=Ex2,Ey1=-Ey2,Ez1=Ez2;
Px1=Px2,Py1=-Py2,Pz1=Pz2。
同时可计算出牵引座轴心1.1O与拉线点距离OP1,OP2长度,记为 L1,L2。
步骤二:求解拉线点位置
测量时,拉线长度传感器检测拉线长度变化量d1,d2,并传递给控制器。求解以下方程数值解,得到新拉线点P′1,P′2点坐标 P′1(Px′1,Py′1,Pz′1),P′2(Px′2,Py′2,Pz′2)。
该方程组表示(1)两拉线点到牵引座轴心1.1距离不变;(2)两拉线点与对应拉线电机距离为测量值;(3)两拉线点之间距离不变;(4)两拉线点垂直高度相同。
该方程组展开为
使用求解该方程数值解,可以解得新拉线点P′1,P′2点坐标 P′1(Px′1,Py′1,Pz′1),P′2(Px′2,Py′2,Pz′2) 。
求解该方程数值解的一种较为简单的方法为枚举Pz′1=Pz′2=z,再根据前四个方程计算P1′,P2′坐标,最后使用第五个方程验证是否符合需求,根据精度需求可以调整枚举z的步长大小。
步长指枚举z时,两个不同的z之间的间隔。如解方程枚举z的区间为-0.1m到0.1m,精度要求不高时,可采取0.05m一个区间进行枚举,分别为-0.1、-0.05、0、0.05、0.1;精度要求高时,采取0.01 为间隔,-0.1、-0.09、-0.08、-0.07...这两个例子中的0.05和0.01即称为步长。
步骤三:求解夹角大小
定义挂车车头与货箱初始位置为夹角0°,实际挂车车头与货箱水平夹角大小可采用如下公式计算:
步骤四:根据长度变化量确定货箱偏转方向
实际旋转方向根据d1,d2大小关系确定,货箱向d小的一侧旋转。即,当d1<d2时,货箱向第一拉线电机2一侧旋转,当d1>d2时,货箱向第二拉线电机3一侧旋转,当d1=d2时,货箱没有旋转。
虽然上面结合本发明的优选实施例对本发明的原理进行了详细的描述,本领域技术人员应该理解,上述实施例仅仅是对本发明的示意性实现方式的解释,并非对本发明包含范围的限定。实施例中的细节并不构成对本发明范围的限制,在不背离本发明的精神和范围的情况下,任何基于本发明技术方案的等效变换、简单替换等显而易见的改变,均落在本发明保护范围之内。
Claims (5)
1.一种测量挂车车头与货箱夹角的方法,其特征在于,所述方法首先将第一拉线电机(2)和第二拉线电机(3)以车头牵引座(1)上的牵引座轴心(1.1)为中心左右对称安装在所述车头牵引座(1)尾部;
将货箱固定座及大梁(5)安装在货箱后部,连接所述货箱固定座及大梁(5)前部中心与所述牵引座轴心(1.1);所述货箱能够围绕所述牵引座轴心(1.1)水平旋转及上下摆动;
以所述牵引座轴心(1.1)为中心对称布置两个货箱连接支架(6),连接所述货箱连接支架(6)上方和所述货箱固定座及大梁(5)后部;两个所述货箱连接支架(6)下部对称设置拉线点(6.1),两个所述拉线点(6.1)与所述第一拉线电机(2)和所述第二拉线电机(3)伸出的拉线分别连接;
其次,所述第一拉线电机(2)和所述第二拉线电机(3)上分别固接拉线长度传感器,所述拉线长度传感器与控制器数据相连;
挂车车头与货箱夹角测量过程如下:
S1、标定几何关系;
测量前,预先标定拉线原始长度,标定牵引座轴心(1.1)、第一拉线电机(2)和第二拉线电机(3)、拉线点的相对位置,标定坐标原点为牵引座轴心(1.1,第一拉线电机(2,两个拉线点位置;牵引座轴心(1.1)O与拉线点距离长度,记为;
S2、求解拉线点位置;
S3、求解夹角大小;
定义挂车车头与货箱初始位置为夹角0°,实际挂车车头与货箱水平夹角大小采用如下公式计算:
S4、根据长度变化量确定货箱偏转方向;
3.一种执行上述权利要求1至2中任一项所述的测量挂车车头与货箱夹角的方法的拉线装置,其特征在于,所述拉线装置包括车头牵引座(1)、第一拉线电机(2)、第二拉线电机(3)、货箱固定座及大梁(5)、货箱连接支架(6)和控制器;
所述第一拉线电机(2)和所述第二拉线电机(3)以所述车头牵引座(1)上的牵引座轴心(1.1)为中心左右对称安装在所述车头牵引座(1)尾部;
所述货箱固定座及大梁(5)前部中心与所述牵引座轴心(1.1)相连接;货箱能够围绕所述牵引座轴心(1.1)水平旋转及上下摆动;
两个所述货箱连接支架(6)以所述牵引座轴心(1.1)为中心对称布置,其上方与安装在所述货箱后部的所述货箱固定座及大梁(5)后部相连接;两个所述货箱连接支架(6)下部对称设有拉线点(6.1),通过所述拉线点(6.1)与所述第一拉线电机(2)和所述第二拉线电机(3)伸出的拉线分别连接;
所述第一拉线电机(2)和所述第二拉线电机(3)上分别固接拉线长度传感器,所述拉线长度传感器与所述控制器数据相连。
4.根据权利要求3所述的执行上述权利要求1至2中任一项所述的测量挂车车头与货箱夹角的方法的拉线装置,其特征在于,所述拉线装置还包括拉线电机安装支架(4),所述车头牵引座(1)底部为安装板(1.2),所述第一拉线电机(2)和所述第二拉线电机(3)通过所述拉线电机安装支架(4)安装在所述安装板(1.2)上。
5.根据权利要求4所述的执行上述权利要求1至2中任一项所述的测量挂车车头与货箱夹角的方法的拉线装置,其特征在于,所述第一拉线电机(2)和所述第二拉线电机(3)通过所述拉线电机安装支架(4)与所述安装板(1.2)螺栓连接。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110214758.5A CN112848822B (zh) | 2021-02-25 | 2021-02-25 | 一种测量挂车车头与货箱夹角的拉线装置及其测量方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110214758.5A CN112848822B (zh) | 2021-02-25 | 2021-02-25 | 一种测量挂车车头与货箱夹角的拉线装置及其测量方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112848822A CN112848822A (zh) | 2021-05-28 |
CN112848822B true CN112848822B (zh) | 2022-12-09 |
Family
ID=75991452
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110214758.5A Active CN112848822B (zh) | 2021-02-25 | 2021-02-25 | 一种测量挂车车头与货箱夹角的拉线装置及其测量方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112848822B (zh) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115930771B (zh) * | 2023-03-03 | 2023-05-12 | 博鼎精工智能科技(山东)有限公司 | 一种角度测量装置及其测量方法 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2006128733A2 (de) * | 2005-06-03 | 2006-12-07 | Werth Messtechnik Gmbh | Koordinatenmessgerät sowie verfahren zum messen eines objektes mit einem koordinatenmessgerät |
JP2016137802A (ja) * | 2015-01-27 | 2016-08-04 | 日野自動車株式会社 | 連結車両の連結角取得装置及び連結車両の運転支援システム |
CN207730189U (zh) * | 2018-01-23 | 2018-08-14 | 石家庄夔龙科技有限公司 | 火炮身管偏移角度的外部无损检测系统 |
WO2018186045A1 (ja) * | 2017-04-03 | 2018-10-11 | アイシン精機株式会社 | 牽引支援装置 |
CN109916391A (zh) * | 2019-03-27 | 2019-06-21 | 山东大学 | 一种机械装备空间位置实时采集装置及其测量系统、方法 |
CN110940257A (zh) * | 2018-09-25 | 2020-03-31 | 国核电站运行服务技术有限公司 | 一种测量管道倾角变化的装置及方法 |
CN111906819A (zh) * | 2020-08-10 | 2020-11-10 | 深圳市智流形机器人技术有限公司 | 拉线测量校准设备、系统、方法 |
Family Cites Families (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2006042665A1 (de) * | 2004-10-15 | 2006-04-27 | Daimlerchrysler Ag | Verfahren zur bestimmung von deichsel- und trailerwinkel |
DE102007038665A1 (de) * | 2007-08-15 | 2009-02-19 | Josef Kotte Landtechnik Gmbh & Co. Kg | Anhänger mit Deichsel und Winkelsensor |
US9296422B2 (en) * | 2011-04-19 | 2016-03-29 | Ford Global Technologies, Llc | Trailer angle detection target plausibility |
US8922647B2 (en) * | 2011-08-03 | 2014-12-30 | The Boeing Company | Projection aided feature measurement using uncalibrated camera |
CN204915151U (zh) * | 2015-09-14 | 2015-12-30 | 河北昌骅专用汽车有限公司 | 一种罐车牵引销座板连接结构 |
CN109677217A (zh) * | 2018-12-27 | 2019-04-26 | 魔视智能科技(上海)有限公司 | 牵引车与挂车偏航角的检测方法 |
CN110949077B (zh) * | 2019-12-24 | 2021-01-19 | 北京欣奕华科技有限公司 | 一种牵引式agv自动脱挂机构 |
CN112389437B (zh) * | 2021-01-21 | 2021-04-13 | 北京主线科技有限公司 | 自动驾驶卡车车头与挂车夹角测量计算装置及方法 |
-
2021
- 2021-02-25 CN CN202110214758.5A patent/CN112848822B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2006128733A2 (de) * | 2005-06-03 | 2006-12-07 | Werth Messtechnik Gmbh | Koordinatenmessgerät sowie verfahren zum messen eines objektes mit einem koordinatenmessgerät |
JP2016137802A (ja) * | 2015-01-27 | 2016-08-04 | 日野自動車株式会社 | 連結車両の連結角取得装置及び連結車両の運転支援システム |
WO2018186045A1 (ja) * | 2017-04-03 | 2018-10-11 | アイシン精機株式会社 | 牽引支援装置 |
CN207730189U (zh) * | 2018-01-23 | 2018-08-14 | 石家庄夔龙科技有限公司 | 火炮身管偏移角度的外部无损检测系统 |
CN110940257A (zh) * | 2018-09-25 | 2020-03-31 | 国核电站运行服务技术有限公司 | 一种测量管道倾角变化的装置及方法 |
CN109916391A (zh) * | 2019-03-27 | 2019-06-21 | 山东大学 | 一种机械装备空间位置实时采集装置及其测量系统、方法 |
CN111906819A (zh) * | 2020-08-10 | 2020-11-10 | 深圳市智流形机器人技术有限公司 | 拉线测量校准设备、系统、方法 |
Non-Patent Citations (1)
Title |
---|
基于单拉线编码器测量系统的几何标定及精度分析;朱煜等;《机械与电子》;20180224(第02期);全文 * |
Also Published As
Publication number | Publication date |
---|---|
CN112848822A (zh) | 2021-05-28 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105005033B (zh) | 用于校准雷达传感器的方法和雷达系统 | |
CN112848822B (zh) | 一种测量挂车车头与货箱夹角的拉线装置及其测量方法 | |
WO2021254468A1 (zh) | 车辆检测系统及车辆检测方法 | |
CN109532937B (zh) | 一种车载地铁限界检测方法及其检测系统 | |
CN101357674B (zh) | 舵柱的安装方法 | |
US20010037164A1 (en) | Method and device for determining the buckling angle between a front vehicle and a semitrailer of a vehicle | |
CN108032868A (zh) | 一种列车轨道检测系统及方法 | |
CN112414652B (zh) | 一种高效高精度白车身静刚度测量系统及测试方法 | |
CN112389437B (zh) | 自动驾驶卡车车头与挂车夹角测量计算装置及方法 | |
CN103017719B (zh) | 踏板运动轨迹测量仪 | |
CN214450082U (zh) | 一种测量挂车车头与货箱夹角的拉线装置 | |
CN113900130A (zh) | 车辆位姿测量方法及车辆 | |
KR20100054534A (ko) | 차체 위치 보정 시스템 및 이를 이용한 차체 위치 보정 방법 | |
CN102539166A (zh) | 一种检测汽车底盘轮胎三维数据的装置和方法 | |
CN104330211B (zh) | 测量副翼转动惯量的测量工装及确定副翼平衡位置的方法 | |
CN108502736B (zh) | 一种基于gnss的塔机吊钩定位方法 | |
CN206339206U (zh) | 一种多晶硅棒空间倾角激光测量装置 | |
CN112406887B (zh) | 一种牵引挂车质心位置的获取方法及获取系统 | |
JP6458476B2 (ja) | 車両特性試験装置 | |
CN112857817B (zh) | 一种运载火箭发动机喷管摆角和摆角加速度测量系统及方法 | |
KR101460022B1 (ko) | 모형선의 설치 오차 최소화 장치 | |
CN108955630B (zh) | 姿态检测方法及姿态检测系统 | |
JP4646042B2 (ja) | 自動車の車輪アライメント測定方法 | |
CN114112448B (zh) | 基于f轨的磁浮车辆动态限界的测试装置和测试方法 | |
CN112082460A (zh) | 测量装置及车钩自由角的测量方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |