CN114065555B - 一种用于岸桥起重机关道内目标识别的纠偏补偿方法 - Google Patents
一种用于岸桥起重机关道内目标识别的纠偏补偿方法 Download PDFInfo
- Publication number
- CN114065555B CN114065555B CN202210037418.4A CN202210037418A CN114065555B CN 114065555 B CN114065555 B CN 114065555B CN 202210037418 A CN202210037418 A CN 202210037418A CN 114065555 B CN114065555 B CN 114065555B
- Authority
- CN
- China
- Prior art keywords
- upright post
- reflector
- side upright
- laser
- error
- 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
- 238000000034 method Methods 0.000 title claims abstract description 13
- 238000001514 detection method Methods 0.000 claims abstract description 13
- 230000008859 change Effects 0.000 claims abstract description 7
- 239000011159 matrix material Substances 0.000 claims description 6
- 230000009466 transformation Effects 0.000 claims description 4
- 230000008447 perception Effects 0.000 description 3
- 230000006870 function Effects 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 238000010276 construction Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000009434 installation Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000002093 peripheral effect Effects 0.000 description 1
- 230000008569 process Effects 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F30/00—Computer-aided design [CAD]
- G06F30/20—Design optimisation, verification or simulation
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C9/00—Measuring inclination, e.g. by clinometers, by levels
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
- G01S17/02—Systems using the reflection of electromagnetic waves other than radio waves
- G01S17/06—Systems determining position data of a target
- G01S17/08—Systems determining position data of a target for measuring distance only
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F17/00—Digital computing or data processing equipment or methods, specially adapted for specific functions
- G06F17/10—Complex mathematical operations
- G06F17/11—Complex mathematical operations for solving equations, e.g. nonlinear equations, general mathematical optimization problems
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Theoretical Computer Science (AREA)
- Mathematical Physics (AREA)
- Data Mining & Analysis (AREA)
- Mathematical Analysis (AREA)
- Mathematical Optimization (AREA)
- Computational Mathematics (AREA)
- Electromagnetism (AREA)
- Pure & Applied Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- General Engineering & Computer Science (AREA)
- Software Systems (AREA)
- Databases & Information Systems (AREA)
- Algebra (AREA)
- Computer Hardware Design (AREA)
- Evolutionary Computation (AREA)
- Geometry (AREA)
- Operations Research (AREA)
- Computer Networks & Wireless Communication (AREA)
- Length Measuring Devices By Optical Means (AREA)
- Control And Safety Of Cranes (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明提出了一种用于岸桥起重机关道内目标识别的纠偏补偿方法,包括如下步骤:在陆侧立柱或海侧立柱上安装激光雷达和反光板;计算岸桥起重机的岸桥倾角和岸桥起重机上的传感器倾斜造成的误差并建立误差模型;根据误差模型得出实际的传感器误差进行补偿以实现纠偏;使用激光雷达检测安装在岸桥立柱顶部的反光板的距离变化,通过算法求得岸桥整体的岸桥倾角,且激光雷达安装在立柱底部,避免了激光受到外部光线干扰影响,保证了激光雷达运行的稳定性,根据误差模型得出实际的传感器误差进行补偿以实现纠偏,进而保证了检测结果的准确性。
Description
技术领域
本发明涉及目标识别技术领域,尤其涉及一种用于岸桥起重机关道内目标识别的纠偏补偿方法。
背景技术
在港口自动化作业任务中,岸桥自动化处于最关键的一环。在岸桥自动化解决方案中,岸桥整体状态的感知又是必不可少的部分。并且,岸桥状态感知结果的精度直接影响了岸桥自动化作业系统的成功率。因此,如何提高感知结果的精度,对于实现一套安全可靠和高效的岸桥自动化作业系统至关重要。
桥吊自动化系统中的感知部分主要有包块吊具定位的感知,车道上集卡位置的感知,集装箱位置的感知等。目前各类感知主要通过包括激光雷达检测,外设相机检测或者安装在目标设备上的传感器检测进行检测。传感器设备安装好后,通常会对设备进行标定校准,以提高传感器的检测精度。但是由于岸桥设备体积大,干扰多,固有的运动部件精度不高,但是自动化改造对于感知要求精度高,导致单纯的标定无法满足精度要求。
鉴于此,实有必要提供一种新型的用于岸桥起重机关道内目标识别的纠偏补偿方法以克服上述缺陷。
发明内容
本发明的目的是提供一种用于岸桥起重机关道内目标识别的纠偏补偿方法,避免了激光受到外部光线干扰影响,保证了激光雷达运行的稳定性,根据误差模型得出实际的传感器误差进行补偿以实现纠偏,进而保证了检测结果的准确性。
为了实现上述目的,本发明提供一种用于岸桥起重机关道内目标识别的纠偏补偿方法,包括如下步骤:
S1:在陆侧立柱或海侧立柱上安装激光雷达和反光板;
S2:计算岸桥起重机的岸桥倾角和岸桥起重机上的传感器倾斜造成的误差并建立误差模型;
岸桥倾角θ r 的计算如下式:
传感器倾斜造成的误差e的计算如下式:
上式(1)和(2)中,θ r 是岸桥倾角,Atan是反正切函数,△h是导轨高度误差,l 0是海侧立柱与陆侧立柱之间的间距,l 1是目标物距离检测传感器距离,e是传感器倾斜造成的误差;
S3:根据误差模型得出实际的传感器误差进行补偿以实现纠偏;
设陆侧立柱的坐标系为{W},陆侧立柱旋转后的坐标系为{W'},令反光板在陆侧立柱的坐标系中的直线方程表达式为:
其中,A0、 B0 、C0均为标准直线方程表达式系数,
激光器照射在反光板上的位置在{W}下的坐标为{x,y};x表示岸桥起重机的小车方向位置,y表示高度方向位置;
当陆侧立柱发生倾斜后,则陆侧立柱倾斜后的反光板上的激光点在{W}坐标下的位置为{x',y'},
{W'}相对于{W}的旋转矩阵表达式为:
{W'}相对于{W}的陆侧立柱的齐次变换矩阵表达式为:
坐标变化可得陆侧立柱倾斜前后反光板上坐标的位置关系:
{x',y'}]代入反光板的直线方程,得到旋转后的直线方程如下式:
其中,A1、 B1 、C1为旋转后的标准直线方程表达式系数,
旋转之前的反光板直线方程与坐标系{W}的y轴交点,
旋转之后的反光板直线方程与坐标系{W}的y轴交点,
优选的,步骤S1还包括步骤S11:安装一维脉冲激光雷达于陆侧立柱的底部,一维脉冲激光雷达的激光器竖直向上发射激光束;在陆侧立柱的顶部安装反光板;调整激光器和反光板的位置使激光器的激光照射在反光板的中央位置。
优选的,陆侧立柱与海侧立柱的间距为20m,陆侧立柱与海侧立柱的高度为40m。
与现有技术相比,有益效果在于:使用激光雷达检测安装在岸桥立柱顶部的反光板的距离变化,通过算法求得岸桥整体的岸桥倾角,且激光雷达安装在立柱底部,避免了激光受到外部光线干扰影响,保证了激光雷达运行的稳定性,根据误差模型得出实际的传感器误差进行补偿以实现纠偏,进而保证了检测结果的准确性。
附图说明
为了更清楚地说明本发明实施例的技术方案,下面将对实施例中所需要使用的附图作简单地介绍,应当理解,以下附图仅示出了本发明的某些实施例,因此不应被看作是对范围的限定,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他相关的附图。
图1为本发明提供的用于岸桥起重机关道内目标识别的纠偏补偿方法的使用示意图。
图2为激光雷达与陆侧立柱的安装示意图。
具体实施方式
为了使本发明的目的、技术方案和有益技术效果更加清晰明白,以下结合附图和具体实施方式,对本发明进行进一步详细说明。应当理解的是,本说明书中描述的具体实施方式仅仅是为了解释本发明,并不是为了限定本发明。
请参阅图1至图2,本发明提供一种用于岸桥起重机关道内目标识别的纠偏补偿方法,该方法用于补偿通过岸桥高处相机或者激光雷达识别关道内目标时由于岸桥倾斜造成的识别误差,包括如下步骤:
S1:安装纠偏激光雷达和反光板;
具体的,步骤S1还包括步骤S11:安装一维激光雷达于岸桥立柱的底部,一维激光雷达的激光器竖直向上发射激光束;
在岸边立柱的顶部安装反光板,所述反光板与岸边立柱呈45度设置;
调整激光器和反光板的位置,使得激光器的激光照射在反光板的中央位置;
在大车移动的过程中,海陆侧两边的高低误差会发生变化,进而导致海陆侧两边的立柱造成上下错动,引起安装在岸桥上方的传感器姿态变化,造成识别误差,进而导致导岸桥起重机的轨高度误差会造成岸桥整体的倾斜形成岸桥倾角;
S2:计算岸桥起重机的岸桥倾角和岸桥起重机上的传感器倾斜造成的误差并建立误差模型;
具体的,由于岸桥起重机铺设在海陆侧两条导轨上,因施工的原因会造成岸桥起重机的两侧导轨存在有±3cm的高低误差,进而造成岸桥整体的倾斜,岸桥倾角θ r 的计算如下式:
传感器倾斜造成的误差e的计算如下式:
上式(1)和(2)中,θ r 是岸桥倾角,Atan是反正切函数,△h是导轨高度误差,l 0是海侧立柱与陆侧立柱之间的间距,l 1是目标物距离检测传感器距离,e是传感器倾斜造成的误差;
在目标物距离检测传感器l 1一定的情况下,检测误差只与导轨高度误差造成的岸桥倾角θ有关,在本实施例中,陆侧立柱与海侧立柱的间距为20m,陆侧立柱与海侧立柱的高度为40m。接下来说明通过加装的一维雷达来计算实际的岸桥倾角;
S3:根据误差模型得出实际的传感器误差进行补偿以实现纠偏;
步骤S3还包括步骤S31:设陆侧立柱的坐标系为{W},陆侧立柱旋转后的坐标系为{W'},令反光板在在陆侧立柱的坐标系中的直线方程表达式为:
其中,A0、 B0 、C0均为标准直线方程表达式系数,
激光器照射在反光板上的位置在{W}下的坐标为{x,y};x表示小车方向位置,y表示高度方向位置;
S32:当岸桥发生倾斜后,则倾斜后的反光板上的激光点在{W}坐标下的位置为{x',y'},
{W'}相对于{W}的岸桥的旋转矩阵表达式为:
{W'}相对于{W}的岸桥的齐次变换矩阵表达式为:
通过坐标变化可得陆侧立柱倾斜前后反光板上坐标的位置关系:
S33: {x',y'}]代入反光板的直线方程,得到旋转后的直线方程如下式:
其中,A1、 B1 、C1为旋转后的标准直线方程表达式系数,
旋转之前的反光板直线方程与坐标系{W}的y轴交点(即激光器到反光板的距离),
旋转之后的反光板直线方程与坐标系{W}的y轴交点,
有益效果在于,本发明使用激光雷达检测安装在陆侧立柱顶部的反光板的距离变化,通过算法求得岸桥整体的岸桥倾角,且激光雷达安装在陆侧立柱底部,避免了激光受到外部光线干扰影响,保证了激光雷达运行的稳定性,根据误差模型得出实际的传感器误差进行补偿以实现纠偏,进而保证了检测结果的准确性。
本发明并不仅仅限于说明书和实施方式中所描述,因此对于熟悉领域的人员而言可容易地实现另外的优点和修改,故在不背离权利要求及等同范围所限定的一般概念的精神和范围的情况下,本发明并不限于特定的细节、代表性的设备和这里示出与描述的示例。
Claims (2)
1.一种用于岸桥起重机关道内目标识别的纠偏补偿方法,其特征在于,包括如下步骤:
S1:在陆侧立柱或海侧立柱上安装激光雷达和反光板;
S2:计算岸桥起重机的岸桥倾角和岸桥起重机上的传感器倾斜造成的误差并建立误差模型;
岸桥倾角θ r 的计算如下式:
传感器倾斜造成的误差e的计算如下式:
上式(1)和(2)中,θ r 是岸桥倾角,atan是反正切函数,△h是导轨高度误差,l 0是海侧立柱与陆侧立柱之间的间距,l 1是目标物距离检测传感器距离,e是传感器倾斜造成的误差,
S3:根据误差模型得出实际的传感器误差进行补偿以实现纠偏;
设陆侧立柱的坐标系为{W},陆侧立柱旋转后的坐标系为{W'},令反光板在陆侧立柱的坐标系中的直线方程表达式为:
其中,A0、 B0、C0均为标准直线方程表达式系数,
激光器照射在反光板上的位置在{W}下的坐标为{x,y};x表示岸桥起重机的小车方向位置,y表示高度方向位置;
当陆侧立柱发生倾斜后,则陆侧立柱倾斜后的反光板上的激光点在{W}坐标下的位置为{x',y'},
{W'}相对于{W}的旋转矩阵表达式为:
{W'}相对于{W}的齐次变换矩阵表达式为:
坐标变化可得陆侧立柱倾斜前后反光板上坐标的位置关系:
{x',y'}代入反光板的直线方程,得到旋转后的直线方程如下式:
其中,A1、 B1 、C1为旋转后的标准直线方程表达式系数,
旋转之前的反光板直线方程与坐标系{W}的y轴交点,
旋转之后的反光板直线方程与坐标系{W}的y轴交点,
2.如权利要求1所述的用于岸桥起重机关道内目标识别的纠偏补偿方法,其特征在于,步骤S1还包括步骤S11:安装一维脉冲激光雷达于陆侧立柱的底部,一维脉冲激光雷达的激光器竖直向上发射激光束;在陆侧立柱的顶部安装反光板;调整激光器和反光板的位置使激光器的激光照射在反光板的中央位置。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210037418.4A CN114065555B (zh) | 2022-01-13 | 2022-01-13 | 一种用于岸桥起重机关道内目标识别的纠偏补偿方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210037418.4A CN114065555B (zh) | 2022-01-13 | 2022-01-13 | 一种用于岸桥起重机关道内目标识别的纠偏补偿方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN114065555A CN114065555A (zh) | 2022-02-18 |
CN114065555B true CN114065555B (zh) | 2022-07-01 |
Family
ID=80231088
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202210037418.4A Active CN114065555B (zh) | 2022-01-13 | 2022-01-13 | 一种用于岸桥起重机关道内目标识别的纠偏补偿方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114065555B (zh) |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102032881A (zh) * | 2009-09-24 | 2011-04-27 | 鞍山钢铁集团公司 | 桥式起重机大车车轮安装的激光测量法 |
CN105540419A (zh) * | 2015-12-21 | 2016-05-04 | 上海新时达电气股份有限公司 | 一种多绳起重系统及其方法 |
CN107664492A (zh) * | 2017-04-01 | 2018-02-06 | 武汉川丰软件技术有限公司 | 港口岸桥激光扫描仪安装的偏转角度测量方法及系统 |
CN108178066A (zh) * | 2017-12-28 | 2018-06-19 | 河南工学院 | 一种双梁起重机小车的纠偏方法 |
CN111285259A (zh) * | 2020-05-09 | 2020-06-16 | 上海胜迈机电科技有限公司 | 系泊装卸时监测集装箱船舶浮态及稳性的多岸桥用系统 |
CN112678665A (zh) * | 2017-07-05 | 2021-04-20 | 住友重机械搬运系统工程株式会社 | 起重机装置 |
CN214733890U (zh) * | 2021-03-25 | 2021-11-16 | 湖南紫荆新材料科技有限公司 | 一种电动双梁桥式起重机的端梁纠偏装置 |
CN113682960A (zh) * | 2021-09-07 | 2021-11-23 | 南华大学 | 可视化塔吊控制系统及控制方法 |
Family Cites Families (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
FI20115922A0 (fi) * | 2011-09-20 | 2011-09-20 | Konecranes Oyj | Nosturin ohjaus |
CN110160499B (zh) * | 2019-06-21 | 2024-05-28 | 西安超越智能科技有限公司 | 一种倾斜监测装置及方法 |
CN111003640A (zh) * | 2019-10-22 | 2020-04-14 | 上海海事大学 | 一种港口起重机大车轨道在线检测系统 |
CN112415493B (zh) * | 2020-11-27 | 2023-06-06 | 北京航天计量测试技术研究所 | 三维扫描激光雷达坐标误差修正方法 |
-
2022
- 2022-01-13 CN CN202210037418.4A patent/CN114065555B/zh active Active
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102032881A (zh) * | 2009-09-24 | 2011-04-27 | 鞍山钢铁集团公司 | 桥式起重机大车车轮安装的激光测量法 |
CN105540419A (zh) * | 2015-12-21 | 2016-05-04 | 上海新时达电气股份有限公司 | 一种多绳起重系统及其方法 |
CN107664492A (zh) * | 2017-04-01 | 2018-02-06 | 武汉川丰软件技术有限公司 | 港口岸桥激光扫描仪安装的偏转角度测量方法及系统 |
CN112678665A (zh) * | 2017-07-05 | 2021-04-20 | 住友重机械搬运系统工程株式会社 | 起重机装置 |
CN108178066A (zh) * | 2017-12-28 | 2018-06-19 | 河南工学院 | 一种双梁起重机小车的纠偏方法 |
CN111285259A (zh) * | 2020-05-09 | 2020-06-16 | 上海胜迈机电科技有限公司 | 系泊装卸时监测集装箱船舶浮态及稳性的多岸桥用系统 |
CN214733890U (zh) * | 2021-03-25 | 2021-11-16 | 湖南紫荆新材料科技有限公司 | 一种电动双梁桥式起重机的端梁纠偏装置 |
CN113682960A (zh) * | 2021-09-07 | 2021-11-23 | 南华大学 | 可视化塔吊控制系统及控制方法 |
Non-Patent Citations (2)
Title |
---|
Inertial measurements processing for sway angle estimation in overhead crane control applications;Václav Helma et al;《2021 IEEE/ASME International Conference on Advanced Intelligent Mechatronics (AIM)》;20210824;全文 * |
岸边集装箱装卸桥吊具减摇装置的研究;魏雨龙;《中国优秀硕士学位论文全文数据库电子期刊 工程科技II辑》;20060415;第2006年卷(第4期);全文 * |
Also Published As
Publication number | Publication date |
---|---|
CN114065555A (zh) | 2022-02-18 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108562889B (zh) | 一种激光雷达坐标校正方法 | |
US9205850B2 (en) | Displacement detecting apparatus for railroad rails | |
US7280211B2 (en) | Method of adjusting monitor axis | |
CN111708038A (zh) | 基于姿态传感器和gnss的无人船激光雷达点云数据校正方法 | |
US7106421B2 (en) | Method of adjusting axial direction of monitoring apparatus | |
JP5361421B2 (ja) | 計測装置、計測装置のレーザー位置姿勢値補正方法およびレーザー位置姿勢値補正プログラム | |
CN110361717B (zh) | 激光雷达-摄像机联合标定靶和联合标定方法 | |
KR102327901B1 (ko) | 이동하는 오브젝트 센서의 정렬을 교정하기 위한 방법 | |
CN108089024B (zh) | 一种车辆速度检测系统及方法 | |
CN111796258B (zh) | 雷达参数标定场的构建方法、构建装置及可读存储介质 | |
CN105737852A (zh) | 激光测距仪位置测量与校正系统及方法 | |
JPH0961126A (ja) | 空間距離測定方法及び空間距離測定装置 | |
CN114065555B (zh) | 一种用于岸桥起重机关道内目标识别的纠偏补偿方法 | |
CN114279392B (zh) | 转向角传感器的校准方法、装置和计算机设备 | |
CN102173297B (zh) | 铁路路轨位移量误差修正检测方法 | |
CN111830519B (zh) | 多传感器融合的测距方法 | |
WO2019113860A1 (zh) | 基于色块标签的虚拟墙构建方法及装置、地图构建方法、可移动电子设备 | |
CN115265493B (zh) | 一种基于非标定相机的车道级定位方法及装置 | |
CN209028202U (zh) | 一种车载毫米波雷达安装位置的标定装置 | |
CN110109146A (zh) | 基于多线激光雷达的路面检测方法及装置 | |
WO2022105303A1 (en) | Method and device for mounting split binocular camera | |
JP2707761B2 (ja) | 車両状態量測定装置 | |
CN109910946B (zh) | 一种跨座式单轨检测车定位方法及装置 | |
CN206959855U (zh) | 一种自动导引运输车的定位系统 | |
JPH1032158A (ja) | 位置検出方法 |
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 | ||
TR01 | Transfer of patent right | ||
TR01 | Transfer of patent right |
Effective date of registration: 20240122 Address after: Room 801, No. 1126 Shenbin South Road, Minhang District, Shanghai, 201107 Patentee after: MATRIXTIME ROBOTICS (SHANGHAI) Co.,Ltd. Country or region after: China Address before: 310000 room 1305, building 4, No. 88, Xiangyuan Road, Gongshu District, Hangzhou City, Zhejiang Province Patentee before: Jushi Lingzhen Technology (Zhejiang) Co.,Ltd. Country or region before: China |