CN107356938A - 一种无人船二维激光雷达自稳装置及其控制方法 - Google Patents
一种无人船二维激光雷达自稳装置及其控制方法 Download PDFInfo
- Publication number
- CN107356938A CN107356938A CN201710800530.8A CN201710800530A CN107356938A CN 107356938 A CN107356938 A CN 107356938A CN 201710800530 A CN201710800530 A CN 201710800530A CN 107356938 A CN107356938 A CN 107356938A
- Authority
- CN
- China
- Prior art keywords
- mrow
- unmanned boat
- servo
- angle
- msub
- 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.)
- Pending
Links
- 238000000034 method Methods 0.000 title claims abstract description 16
- 230000006641 stabilisation Effects 0.000 claims abstract description 9
- 238000011105 stabilization Methods 0.000 claims abstract description 9
- 230000036632 reaction speed Effects 0.000 claims abstract description 5
- 230000005540 biological transmission Effects 0.000 claims description 8
- 230000004927 fusion Effects 0.000 claims description 5
- 230000003068 static effect Effects 0.000 claims description 4
- 238000004364 calculation method Methods 0.000 claims description 3
- 230000010354 integration Effects 0.000 claims description 3
- 230000005611 electricity Effects 0.000 claims description 2
- 238000005070 sampling Methods 0.000 claims description 2
- 230000004888 barrier function Effects 0.000 abstract description 6
- 230000001133 acceleration Effects 0.000 description 10
- 238000001514 detection method Methods 0.000 description 3
- 230000005484 gravity Effects 0.000 description 3
- 239000011159 matrix material Substances 0.000 description 3
- 238000005259 measurement Methods 0.000 description 2
- 230000007613 environmental effect Effects 0.000 description 1
- 238000002360 preparation method Methods 0.000 description 1
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 description 1
Classifications
-
- 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/88—Lidar systems specially adapted for specific applications
- G01S17/93—Lidar systems specially adapted for specific applications for anti-collision purposes
-
- 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
- G01S7/00—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00
- G01S7/48—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S17/00
- G01S7/481—Constructional features, e.g. arrangements of optical elements
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Computer Networks & Wireless Communication (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Electromagnetism (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明公开了一种无人船二维激光雷达自稳装置及其控制方法,所述装置包括第一旋转轴、第二旋转轴和伺服控制系统,第二旋转轴安装在第一旋转轴上,第二旋转轴用于安装二维激光雷达。本发明通过将自稳装置应用到无人船二维激光雷达上,实现了二维激光雷达测距在同一平面上,解决了因无人船摇摆导致误将水平面判定为障碍物的问题,隔离了各种干扰对二维激光雷达测距的影响,从而实现了二维激光雷达随动位姿稳定控制。本发明通过卡尔曼滤波方法,将加速度计和陀螺仪输出的角度值进行融合,实现了无人船横滚角和俯仰角的准确获得。本发明通过对伺服电机进行双闭环PID控制,实现了伺服控制系统动态响应的快速性,提高了伺服电机扭矩的反应速度。
Description
技术领域
本发明属于无人船领域,尤其涉及一种无人船二维激光雷达自稳装置及其控制方法。
背景技术
激光雷达是实现无人船环境感知的重要传感器,对于实现无人船自主导航避障、检测无人船航行环境的障碍物起着重要的作用。而二维激光雷达在一固定平面上,可以感知无人船360度的环境信息,将检测到的障碍物距离和角度数据发送到无人船的控制伺服控制系统。但是由于无人船在执行作业任务时,经常受到风浪等干扰使无人船产生摇摆。此时二维激光雷达易受到无人船摇摆产生的角度和角速度的影响,使得测量的数据不在预定平面上,导致无人船的控制伺服控制系统对障碍物误判。
发明内容
为解决现有技术存在的上述问题,本发明要设计一种能够消除无人船摇摆引起的倾斜对角度和角速度的影响,隔离各种扰动对激光雷达检测障碍物的影响,实现二维激光雷达随动位姿稳定控制的无人船二维激光雷达自稳装置及其控制方法。
为了实现上述目的,本发明的技术方案如下:一种无人船二维激光雷达自稳装置,包括底座、第一支架、第一旋转轴、第二支架、第二旋转轴、第三支架和伺服控制系统,所述第一旋转轴通过第一支架安装在底座上,所述第二旋转轴通过第二支架安装在第一旋转轴上,所述第三支架安装在第二旋转轴上;所述底座固定在无人船上,所述第三支架用于安装二维激光雷达;所述第一旋转轴与第二旋转轴在空间上相互垂直;
所述伺服控制系统包括伺服控制器、加速度计、陀螺仪、横滚伺服电机、俯仰伺服电机和光栅编码器;所述横滚伺服电机与第一旋转轴连接,所述俯仰伺服电机与第二旋转轴连接;所述光栅编码器有两个,分别与横滚伺服电机和俯仰伺服电机连接;所述伺服控制器、加速度计和陀螺仪安装在无人船上;所述伺服控制器通过导线分别与光栅编码器、加速度计和陀螺仪连接;
所述加速度计与陀螺仪提供无人船的姿态信息;所述伺服控制器接收来自加速度计和陀螺仪的无人船姿态信息,并且与光栅编码器传输来的伺服电机位置和速度信息进行对比,采用双闭环PID控制,实现二维激光雷达的自稳;所述光栅编码器有两个,分别检测横滚伺服电机和俯仰伺服电机的运行状态,所述运行状态包括角度和位置信息。
进一步地,所述的第一旋转轴与无人船的纵向轴线垂直。
一种无人船二维激光雷达自稳装置的控制方法,包括以下步骤:
A、获取无人船准确的横滚角和俯仰角信息
根据陀螺仪在动态时测量较准确但静态时性能较差、加速度计在静态时测量较准确但动态时性能较差的特点,通过卡尔曼滤波方法进行数据融合,得到无人船准确的横滚角和俯仰角信息。
B、双闭环PID控制
伺服控制器接收来自加速度计和陀螺仪的无人船姿态信息,并且与光栅编码器传输来的伺服电机位置和速度信息进行对比,采用双闭环PID控制,实现自稳。所述双闭环PID控制,外环是位置环,即角度环,内环是速度环,即角速度环。所述角度环,为控制的目标环,是控制所需要达到的目标,即补偿无人船摇摆所产生的横滚角/俯仰角。所述角速度环,是外环角度的导数,是为了提升伺服控制系统稳定性。角度环控制模式下伺服控制系统的动态响应速度较慢,在角度环控制的同时加入角速度控制,以改善扭矩的反应速度,使伺服控制系统快速平稳的工作,达到随动位姿稳定控制。
所述PID控制采用位置式PID控制:
式中u(t)为PID输出值,error(t)为期望值与实际值之差,kp、ki、kd分别为比例、积分、微分的系数。
然后将积分量、微分量离散化得到PID计算公式:
式中T为采样时间。
根据公式(2),角度环PID控制算法为:
式中,e(t)为加速度计、陀螺仪传输的无人船角度姿态信息和光栅编码器传输的伺服电机角度位置信息的偏差。
根据公式(2),同理得角速度环PID控制算法:
式(4)中,e′(t)为加速度计、陀螺仪传输的无人船角速度姿态信息和微分伺服电机角度位置得到的角速度信息之间的偏差。
伺服控制器根据计算的AnglePIDOut和AngleRatePIDOut,转化为横滚伺服电机和俯仰伺服电机的控制量,输出到相应伺服电机以控制激光雷达的稳定。
与现有技术相比,本发明具有以下有益效果:
1、本发明通过将自稳装置应用到无人船二维激光雷达上,实现了二维激光雷达测距在同一平面上,解决了因无人船摇摆导致误将水平面判定为障碍物的问题,隔离了各种干扰对二维激光雷达测距的影响,从而实现了二维激光雷达随动位姿稳定控制。
2、本发明通过卡尔曼滤波方法,将加速度计和陀螺仪输出的角度值进行融合,实现了无人船横滚角和俯仰角的准确获得。
3、本发明通过对伺服电机进行双闭环PID控制,实现了伺服控制系统动态响应的快速性,提高了伺服电机扭矩的反应速度。
附图说明
图1是激光雷达自稳装置正视图。
图2是激光雷达自稳装置左视图。
图3是激光雷达自稳装置俯视图。
图4是伺服控制系统结构图。
图5是伺服电机双闭环控制。
图中:1、底座,2、第一支架,3、第一旋转轴,4、第二支架,5、第二旋转轴,6、第三支架,7、二维激光雷达,8、横滚伺服电机,9、俯仰伺服电机。
具体实施方式
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述。
如图1-3所示,本发明的装置通过最下部的底座1固定在无人船上。底座1通过第一支架2与第一旋转轴3连接,第一旋转轴3由横滚伺服电机8控制旋转,用以补偿无人船因外界扰动产生的横滚角。横滚伺服电机8是一个用脉宽调制来产生精准角度位置的定位电机。输入横滚伺服电机8的PWM的占空比决定了横滚伺服电机8的角度值,并且占空比和横滚伺服电机8所处角度值成线性关系,根据线性比值,来将横滚伺服电机8定位到期望的角度。第一个旋转轴通过第二支架4与第二个旋转轴连接,第二旋转轴5由俯仰伺服电机9控制,用以补偿无人船因外界扰动产生的俯仰角。第二旋转轴5通过第三支架6与二维激光雷达7相连,二维激光雷达7固定在第三支架6的顶部,二维激光雷达7自身可以进行360度旋转,以检测无人船周围的障碍物。
本发明通过伺服控制系统实现无人船二维激光雷达7随动位姿稳定控制。如图4所示,所述伺服控制系统由伺服控制器、加速度计、陀螺仪、横滚伺服电机8、俯仰伺服电机9、光栅编码器组成。
所述加速度计与陀螺仪提供无人船的姿态信息。在无人船匀速航行过程中,重力加速度可以分解成x、y、z三个方向的分加速度。而加速度计可以测量某一时刻x、y、z三个方向的加速度值。利用各个方向的分量与重力加速度的比值可以得到无人船的横滚角和俯仰角。但是,在无人船加速航行过程中,加速度计获得的加速度包含船体的加速度,所以无人船在运动时用加速度计获得无人船的姿态信息会有一定的误差存在。此外,陀螺仪输出角速度信息,对角速度进行积分,即可获得无人船的姿态角度信息。但是通过多次累加,产生的角度误差也比较大。但是陀螺仪自身的优点是受加速度影响较小。所以本发明结合两种姿态传感器的特点,将产生的数据经过伺服控制器进行融合处理,得到无人船准确的姿态信息。
所述融合处理,就是通过卡尔曼滤波方法,得到最优角度的估计值。
设加速度计输出角度为陀螺仪输出角度为以及Δt时间内陀螺仪输出角度的变化量以上三个量作为伺服控制系统状态量,则伺服控制系统的状态方程和观测方程为:
上式中,Va是加速度计的过程噪声,它的协方差为Qa;Vg是陀螺仪的过程噪声,它的协方差为Qg;Y(K)为观测信号,按照陀螺仪的权重1-m和加速度计的权重m相加得到。Vk为观测噪声,其协方差为Rk。
定义Δa为无人船加速运行时的估计算子:Δa=|a-gc|/gc,其中a为无人船的加速度,gc为重力加速度。无人船加速度越大,Δa值越小,m值越大,加速度计输出的角度可信度越小,其具体计算公式为:
伺服控制系统的预测协方差阵为:
P(k|k-1)=AP(k-1|k-1)AT+Q
伺服控制系统的增益方程为:
K(k)=P(k|k-1)HT(HP(k|k-1)HT+Rk)-1
其中:
H为观测矩阵。
根据增益,计算伺服控制系统的状态变量,并且更新协方差阵,在进行迭代运算,得到融合的测量角度X(kk):
最优角度的估计值为:
式中,和分别为陀螺仪和加速度计测得的无人船横滚角,和分别为陀螺仪和加速度计测得的无人船俯仰角,和分别为伺服控制系统观测无人船的横滚角和俯仰角。
所述光栅编码器可以输出自稳装置的角度位置信息,并且经过差分可以求得角速度信息。本发明中包含两个光栅编码器,分别检测横滚伺服电机8和俯仰伺服电机9的运行状态。
所述伺服控制器接收来自加速度计和陀螺仪的无人船姿态信息和光栅编码器关于伺服电机的角度位置信息和角速度信息,然后进行控制算法运算,输出PWM波信号给横滚伺服电机8和俯仰伺服电机9。
所述控制算法,是对横滚伺服电机8和俯仰伺服电机9分别进行双闭环PID控制。
双闭环PID控制,外环是位置环,即角度环,内环是速度环,即角速度环。所述角度环,为控制的目标环,是控制所需要达到的目标,即补偿无人船摇摆所产生的横滚角/俯仰角。所述角速度环,是外环角度的导数,是为了提升伺服控制系统稳定性。角度环控制模式下伺服控制系统的动态响应速度较慢,在角度环控制的同时加入角速度控制,以改善扭矩的反应速度,使伺服控制系统快速平稳的工作,达到随动位姿稳定控制。
如图5所示,以控制横滚伺服电机8为例,介绍双闭环PID控制方法。执行作业任务的无人船因受风、浪、流等外界干扰,产生摇摆。首先无人船的加速度和陀螺仪输出无人船的姿态信息,经过伺服控制器的融合,得到准确的无人船横滚角。此时需要伺服控制系统对二维激光雷达7进行伺服校正。所述伺服校正包含位置校正和速度校正。位置校正是双闭环PID控制的外环,功能为完成伺服控制算法对自稳装置横滚角位置校正。位置校正的输入为无人船的横滚角和光栅编码器采样得到的横滚伺服电机8的绝对角度值信息,根据横滚角和角度值信息进行位置校正。输出的数据作为速度校正的输入。其中,光栅编码器输出的横滚伺服电机8的角度信息,经伺服控制器进行微分运算,得到横滚伺服电机8的角速度信息,此信息作为速度环的反馈量。速度校正是双闭环PID控制的内环,功能为完成伺服控制算法对自稳装置横滚角速度的校正。速度校正的输入为位置校正的输出和微分运算得到的横滚伺服电机8的角速度,经过角速度PID控制,输出PWM波信号控制横滚伺服电机8到达随动位姿稳定控制。俯仰伺服电机9的控制与横滚伺服电机8的控制方法相同,两者相互独立。
本发明不局限于本实施例,任何在本发明披露的技术范围内的等同构思或者改变,均列为本发明的保护范围。
Claims (3)
1.一种无人船二维激光雷达自稳装置,其特征在于:包括底座(1)、第一支架(2)、第一旋转轴(3)、第二支架(4)、第二旋转轴(5)、第三支架(6)和伺服控制系统,所述第一旋转轴(3)通过第一支架(2)安装在底座(1)上,所述第二旋转轴(5)通过第二支架(4)安装在第一旋转轴(3)上,所述第三支架(6)安装在第二旋转轴(5)上;所述底座(1)固定在无人船上,所述第三支架(6)用于安装二维激光雷达(7);所述第一旋转轴(3)与第二旋转轴(5)在空间上相互垂直;
所述伺服控制系统包括伺服控制器、加速度计、陀螺仪、横滚伺服电机(8)、俯仰伺服电机(9)和光栅编码器;所述横滚伺服电机(8)与第一旋转轴(3)连接,所述俯仰伺服电机(9)与第二旋转轴(5)连接;所述光栅编码器有两个,分别与横滚伺服电机(8)和俯仰伺服电机(9)连接;所述伺服控制器、加速度计和陀螺仪安装在无人船上;所述伺服控制器通过导线分别与光栅编码器、加速度计和陀螺仪连接;
所述加速度计与陀螺仪提供无人船的姿态信息;所述伺服控制器接收来自加速度计和陀螺仪的无人船姿态信息,并且与光栅编码器传输来的伺服电机位置和速度信息进行对比,采用双闭环PID控制,实现二维激光雷达(7)的自稳;所述光栅编码器有两个,分别检测横滚伺服电机(8)和俯仰伺服电机(9)的运行状态,所述运行状态包括角度和位置信息。
2.根据权利要求1所述的一种无人船二维激光雷达自稳装置,其特征在于:所述的第一旋转轴(3)与无人船的纵向轴线垂直。
3.一种无人船二维激光雷达自稳装置的控制方法,其特征在于:包括以下步骤:
A、获取无人船准确的横滚角和俯仰角信息
根据陀螺仪在动态时测量较准确但静态时性能较差、加速度计在静态时测量较准确但动态时性能较差的特点,通过卡尔曼滤波方法进行数据融合,得到无人船准确的横滚角和俯仰角信息;
B、双闭环PID控制
伺服控制器接收来自加速度计和陀螺仪的无人船姿态信息,并且与光栅编码器传输来的伺服电机位置和速度信息进行对比,采用双闭环PID控制,实现自稳;所述双闭环PID控制,外环是位置环,即角度环,内环是速度环,即角速度环;所述角度环,为控制的目标环,是控制所需要达到的目标,即补偿无人船摇摆所产生的横滚角/俯仰角;所述角速度环,是外环角度的导数,是为了提升伺服控制系统稳定性;角度环控制模式下伺服控制系统的动态响应速度较慢,在角度环控制的同时加入角速度控制,以改善扭矩的反应速度,使伺服控制系统快速平稳的工作,达到随动位姿稳定控制;
所述PID控制采用位置式PID控制:
<mrow>
<mi>u</mi>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<msub>
<mi>k</mi>
<mi>p</mi>
</msub>
<mi>e</mi>
<mi>r</mi>
<mi>r</mi>
<mi>o</mi>
<mi>r</mi>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mo>+</mo>
<msub>
<mi>k</mi>
<mi>i</mi>
</msub>
<msubsup>
<mo>&Integral;</mo>
<mn>0</mn>
<mi>t</mi>
</msubsup>
<mi>e</mi>
<mi>r</mi>
<mi>r</mi>
<mi>o</mi>
<mi>r</mi>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
<mi>d</mi>
<mi>t</mi>
<mo>+</mo>
<msub>
<mi>k</mi>
<mi>d</mi>
</msub>
<mfrac>
<mrow>
<mi>d</mi>
<mi>e</mi>
<mi>r</mi>
<mi>r</mi>
<mi>o</mi>
<mi>r</mi>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<mi>d</mi>
<mi>t</mi>
</mrow>
</mfrac>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>1</mn>
<mo>)</mo>
</mrow>
</mrow>
式中u(t)为PID输出值,error(t)为期望值与实际值之差,kp、ki、kd分别为比例、积分、微分的系数;
然后将积分量、微分量离散化得到PID计算公式:
<mrow>
<mi>u</mi>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<msub>
<mi>k</mi>
<mi>p</mi>
</msub>
<mi>e</mi>
<mi>r</mi>
<mi>r</mi>
<mi>o</mi>
<mi>r</mi>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mo>+</mo>
<msub>
<mi>k</mi>
<mi>i</mi>
</msub>
<munderover>
<mo>&Sigma;</mo>
<mrow>
<mi>j</mi>
<mo>=</mo>
<mn>0</mn>
</mrow>
<mi>t</mi>
</munderover>
<mi>e</mi>
<mi>r</mi>
<mi>r</mi>
<mi>o</mi>
<mi>r</mi>
<mo>(</mo>
<mi>j</mi>
<mo>)</mo>
<mi>T</mi>
<mo>+</mo>
<msub>
<mi>k</mi>
<mi>d</mi>
</msub>
<mfrac>
<mrow>
<mi>e</mi>
<mi>r</mi>
<mi>r</mi>
<mi>o</mi>
<mi>r</mi>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mo>-</mo>
<mi>e</mi>
<mi>r</mi>
<mi>r</mi>
<mi>o</mi>
<mi>r</mi>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>-</mo>
<mn>1</mn>
<mo>)</mo>
</mrow>
</mrow>
<mi>T</mi>
</mfrac>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>2</mn>
<mo>)</mo>
</mrow>
</mrow>
式中T为采样时间;
根据公式(2),角度环PID控制算法为:
<mrow>
<mi>A</mi>
<mi>n</mi>
<mi>g</mi>
<mi>l</mi>
<mi>e</mi>
<mi>P</mi>
<mi>I</mi>
<mi>D</mi>
<mi>O</mi>
<mi>u</mi>
<mi>t</mi>
<mo>=</mo>
<msub>
<mi>k</mi>
<mi>p</mi>
</msub>
<mi>e</mi>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mo>+</mo>
<msub>
<mi>k</mi>
<mi>i</mi>
</msub>
<munderover>
<mo>&Sigma;</mo>
<mrow>
<mi>j</mi>
<mo>=</mo>
<mn>0</mn>
</mrow>
<mi>t</mi>
</munderover>
<mi>e</mi>
<mo>(</mo>
<mi>j</mi>
<mo>)</mo>
<mi>T</mi>
<mo>+</mo>
<msub>
<mi>k</mi>
<mi>d</mi>
</msub>
<mfrac>
<mrow>
<mi>e</mi>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mo>-</mo>
<mi>e</mi>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>-</mo>
<mn>1</mn>
<mo>)</mo>
</mrow>
</mrow>
<mi>T</mi>
</mfrac>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>3</mn>
<mo>)</mo>
</mrow>
</mrow>
式中,e(t)为加速度计、陀螺仪传输的无人船角度姿态信息和光栅编码器传输的伺服电机角度位置信息的偏差;
根据公式(2),同理得角速度环PID控制算法:
<mrow>
<mi>A</mi>
<mi>n</mi>
<mi>g</mi>
<mi>l</mi>
<mi>e</mi>
<mi>R</mi>
<mi>a</mi>
<mi>t</mi>
<mi>e</mi>
<mi>P</mi>
<mi>I</mi>
<mi>D</mi>
<mi>O</mi>
<mi>u</mi>
<mi>t</mi>
<mo>=</mo>
<msubsup>
<mi>k</mi>
<mi>p</mi>
<mo>&prime;</mo>
</msubsup>
<msup>
<mi>e</mi>
<mo>&prime;</mo>
</msup>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mo>+</mo>
<msubsup>
<mi>k</mi>
<mi>i</mi>
<mo>&prime;</mo>
</msubsup>
<munderover>
<mi>&Sigma;</mi>
<mrow>
<mi>j</mi>
<mo>=</mo>
<mn>0</mn>
</mrow>
<mi>t</mi>
</munderover>
<msup>
<mi>e</mi>
<mo>&prime;</mo>
</msup>
<mrow>
<mo>(</mo>
<mi>j</mi>
<mo>)</mo>
</mrow>
<mi>T</mi>
<mo>+</mo>
<msubsup>
<mi>k</mi>
<mi>d</mi>
<mo>&prime;</mo>
</msubsup>
<mfrac>
<mrow>
<msup>
<mi>e</mi>
<mo>&prime;</mo>
</msup>
<mrow>
<mo>(</mo>
<mi>t</mi>
<mo>)</mo>
</mrow>
<mo>-</mo>
<msup>
<mi>e</mi>
<mo>&prime;</mo>
</msup>
<mrow>
<mo>(</mo>
<mrow>
<mi>t</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
<mo>)</mo>
</mrow>
</mrow>
<mi>T</mi>
</mfrac>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>4</mn>
<mo>)</mo>
</mrow>
</mrow>
式(4)中,e′(t)为加速度计、陀螺仪传输的无人船角速度姿态信息和微分伺服电机角度位置得到的角速度信息之间的偏差;
伺服控制器根据计算的AnglePIDOut和AngleRatePIDOut,转化为横滚伺服电机(8)和俯仰伺服电机(9)的控制量,输出到相应伺服电机以控制激光雷达的稳定。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710800530.8A CN107356938A (zh) | 2017-09-07 | 2017-09-07 | 一种无人船二维激光雷达自稳装置及其控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710800530.8A CN107356938A (zh) | 2017-09-07 | 2017-09-07 | 一种无人船二维激光雷达自稳装置及其控制方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN107356938A true CN107356938A (zh) | 2017-11-17 |
Family
ID=60291244
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710800530.8A Pending CN107356938A (zh) | 2017-09-07 | 2017-09-07 | 一种无人船二维激光雷达自稳装置及其控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107356938A (zh) |
Cited By (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108051787A (zh) * | 2017-12-05 | 2018-05-18 | 上海无线电设备研究所 | 一种弹载雷达挂飞试验方法 |
CN108089599A (zh) * | 2017-12-22 | 2018-05-29 | 安徽仁信安防电子工程有限公司 | 一种海面雷达探测方向控制装置及其使用方法 |
CN108227739A (zh) * | 2017-12-29 | 2018-06-29 | 北京臻迪科技股份有限公司 | 水下自动驾驶设备的近距离避障方法及水下自动驾驶设备 |
CN108248879A (zh) * | 2018-01-26 | 2018-07-06 | 广东容祺智能科技有限公司 | 一种无人机的二维测距传感器自稳装置 |
CN109507110A (zh) * | 2018-09-27 | 2019-03-22 | 中国船舶工业系统工程研究院 | 一种激光探测系统舰用转台 |
CN109917411A (zh) * | 2019-04-17 | 2019-06-21 | 重庆大学 | 基于激光测距和三轴加速度计的障碍物检测装置及方法 |
CN110879394A (zh) * | 2019-12-26 | 2020-03-13 | 湖南纳雷科技有限公司 | 基于运动姿态信息的无人船雷达避障系统及方法 |
CN111537979A (zh) * | 2020-04-30 | 2020-08-14 | 上海禾赛光电科技有限公司 | 激光雷达及其控制方法 |
CN112099052A (zh) * | 2020-09-16 | 2020-12-18 | 广东工业大学 | 一种激光雷达水平调节系统 |
CN112180915A (zh) * | 2020-09-16 | 2021-01-05 | 哈尔滨工业大学(威海) | 基于ros的双推力无人船运动控制系统及控制方法 |
CN113418493A (zh) * | 2021-07-23 | 2021-09-21 | 广东工业大学 | 一种基于陀螺仪辅助测量伺服电机角度的方法 |
CN114063436A (zh) * | 2021-10-09 | 2022-02-18 | 广州大学 | 一种水面机器人抗干扰控制方法、系统、设备及介质 |
CN115469313A (zh) * | 2022-11-15 | 2022-12-13 | 成都远望探测技术有限公司 | 用于海上船载气象雷达的波束控制装置及方法 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN200954872Y (zh) * | 2006-06-15 | 2007-10-03 | 哈尔滨工程大学 | 捷联式三维稳定平台 |
CN103149948A (zh) * | 2013-02-04 | 2013-06-12 | 北京航空航天大学 | 一种两自由度大负载跟踪稳定平台系统 |
CN204188800U (zh) * | 2014-09-28 | 2015-03-04 | 北京环境特性研究所 | 带运动补偿的伺服平台 |
CN105786027A (zh) * | 2016-05-13 | 2016-07-20 | 郑文和 | 云台控制器的控制算法 |
CN106323282A (zh) * | 2016-07-14 | 2017-01-11 | 中北大学 | 一种适应多种环境的稳定平台 |
CN106896820A (zh) * | 2017-02-27 | 2017-06-27 | 北京星网卫通科技开发有限公司 | 惯性稳定平台及其控制方法 |
CN107064909A (zh) * | 2017-06-01 | 2017-08-18 | 北京怡孚和融科技有限公司 | 一种激光雷达指向性稳定器和激光雷达指向性稳定系统及一种激光雷达的补偿方法 |
-
2017
- 2017-09-07 CN CN201710800530.8A patent/CN107356938A/zh active Pending
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN200954872Y (zh) * | 2006-06-15 | 2007-10-03 | 哈尔滨工程大学 | 捷联式三维稳定平台 |
CN103149948A (zh) * | 2013-02-04 | 2013-06-12 | 北京航空航天大学 | 一种两自由度大负载跟踪稳定平台系统 |
CN204188800U (zh) * | 2014-09-28 | 2015-03-04 | 北京环境特性研究所 | 带运动补偿的伺服平台 |
CN105786027A (zh) * | 2016-05-13 | 2016-07-20 | 郑文和 | 云台控制器的控制算法 |
CN106323282A (zh) * | 2016-07-14 | 2017-01-11 | 中北大学 | 一种适应多种环境的稳定平台 |
CN106896820A (zh) * | 2017-02-27 | 2017-06-27 | 北京星网卫通科技开发有限公司 | 惯性稳定平台及其控制方法 |
CN107064909A (zh) * | 2017-06-01 | 2017-08-18 | 北京怡孚和融科技有限公司 | 一种激光雷达指向性稳定器和激光雷达指向性稳定系统及一种激光雷达的补偿方法 |
Non-Patent Citations (1)
Title |
---|
李猛: "两轴船载稳定平台控制系统设计与研究" * |
Cited By (18)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108051787A (zh) * | 2017-12-05 | 2018-05-18 | 上海无线电设备研究所 | 一种弹载雷达挂飞试验方法 |
CN108089599B (zh) * | 2017-12-22 | 2020-10-16 | 安徽仁信电子工程有限公司 | 一种海面雷达探测方向控制装置及其使用方法 |
CN108089599A (zh) * | 2017-12-22 | 2018-05-29 | 安徽仁信安防电子工程有限公司 | 一种海面雷达探测方向控制装置及其使用方法 |
CN108227739B (zh) * | 2017-12-29 | 2022-01-21 | 臻迪科技股份有限公司 | 水下自动驾驶设备的近距离避障方法及水下自动驾驶设备 |
CN108227739A (zh) * | 2017-12-29 | 2018-06-29 | 北京臻迪科技股份有限公司 | 水下自动驾驶设备的近距离避障方法及水下自动驾驶设备 |
CN108248879A (zh) * | 2018-01-26 | 2018-07-06 | 广东容祺智能科技有限公司 | 一种无人机的二维测距传感器自稳装置 |
CN109507110A (zh) * | 2018-09-27 | 2019-03-22 | 中国船舶工业系统工程研究院 | 一种激光探测系统舰用转台 |
CN109917411A (zh) * | 2019-04-17 | 2019-06-21 | 重庆大学 | 基于激光测距和三轴加速度计的障碍物检测装置及方法 |
CN109917411B (zh) * | 2019-04-17 | 2023-04-18 | 重庆大学 | 基于激光测距和三轴加速度计的障碍物检测装置及方法 |
CN110879394A (zh) * | 2019-12-26 | 2020-03-13 | 湖南纳雷科技有限公司 | 基于运动姿态信息的无人船雷达避障系统及方法 |
CN111537979A (zh) * | 2020-04-30 | 2020-08-14 | 上海禾赛光电科技有限公司 | 激光雷达及其控制方法 |
CN112180915A (zh) * | 2020-09-16 | 2021-01-05 | 哈尔滨工业大学(威海) | 基于ros的双推力无人船运动控制系统及控制方法 |
CN112099052A (zh) * | 2020-09-16 | 2020-12-18 | 广东工业大学 | 一种激光雷达水平调节系统 |
CN113418493A (zh) * | 2021-07-23 | 2021-09-21 | 广东工业大学 | 一种基于陀螺仪辅助测量伺服电机角度的方法 |
CN113418493B (zh) * | 2021-07-23 | 2024-02-27 | 广东工业大学 | 一种基于陀螺仪辅助测量伺服电机角度的方法 |
CN114063436A (zh) * | 2021-10-09 | 2022-02-18 | 广州大学 | 一种水面机器人抗干扰控制方法、系统、设备及介质 |
CN114063436B (zh) * | 2021-10-09 | 2023-09-26 | 广州大学 | 一种水面机器人抗干扰控制方法、系统、设备及介质 |
CN115469313A (zh) * | 2022-11-15 | 2022-12-13 | 成都远望探测技术有限公司 | 用于海上船载气象雷达的波束控制装置及方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107356938A (zh) | 一种无人船二维激光雷达自稳装置及其控制方法 | |
US6704619B1 (en) | Method and system for universal guidance and control of automated machines | |
CN101033973B (zh) | 微小型飞行器微惯性组合导航系统的姿态确定方法 | |
KR101370649B1 (ko) | 무인잠수정의 경로 제어방법 | |
JP5010332B2 (ja) | 水中航走体運動制御装置および水中航走体 | |
CN104811588B (zh) | 一种基于陀螺仪的船载稳像控制方法 | |
CN102608596A (zh) | 一种用于机载惯性/多普勒雷达组合导航系统的信息融合方法 | |
CN101872198A (zh) | 车载摄像稳定平台 | |
CN114200948B (zh) | 一种基于视觉辅助的无人机自主着舰方法 | |
CN104181815B (zh) | 一种基于环境估计的船舶运动补偿控制方法 | |
JP5042905B2 (ja) | 船舶用自動操舵装置 | |
CN110702110A (zh) | 一种基于无迹卡尔曼滤波的舰船升沉运动测量方法 | |
US20220260398A1 (en) | Magnetic Encoder Calibration | |
CN207114762U (zh) | 一种无人船二维激光雷达自稳装置 | |
JPH10128688A (ja) | ロボットの非干渉化制御方法 | |
KR20120067464A (ko) | 관성항법장치를 이용한 짐발의 좌표 지향 장치 및 이를 이용한 좌표 지향 방법 | |
CN114879703B (zh) | 水下机器人路径跟踪控制方法 | |
CN106772243A (zh) | 一种爬行焊接机器人和焊缝间夹角估计方法 | |
Bonci et al. | The Double Propeller Ducted-Fan, an UAV for safe Infrastructure inspection and human-interaction | |
CN110703765B (zh) | 一种无人船的碰撞自规避方法及系统 | |
US20140172170A1 (en) | Method and system for extracting intended torque for wearable robot | |
Bibuli et al. | Discrete-time sliding mode control for guidance of an unmanned surface vehicle | |
JPH06332535A (ja) | ロボットの制御装置 | |
McKenzie | Motion Compensation and Robotic Control of Maritime Cranes | |
JP5057224B2 (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 | ||
WD01 | Invention patent application deemed withdrawn after publication |
Application publication date: 20171117 |
|
WD01 | Invention patent application deemed withdrawn after publication |