CN103345269B - 一种激光发射装置及自动追踪方法 - Google Patents
一种激光发射装置及自动追踪方法 Download PDFInfo
- Publication number
- CN103345269B CN103345269B CN201310269008.3A CN201310269008A CN103345269B CN 103345269 B CN103345269 B CN 103345269B CN 201310269008 A CN201310269008 A CN 201310269008A CN 103345269 B CN103345269 B CN 103345269B
- Authority
- CN
- China
- Prior art keywords
- mrow
- msub
- laser
- coordinate
- mfrac
- 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.)
- Expired - Fee Related
Links
- 238000000034 method Methods 0.000 title claims abstract description 15
- 238000005070 sampling Methods 0.000 claims description 3
- 238000004364 calculation method Methods 0.000 claims description 2
- 238000011897 real-time detection Methods 0.000 claims description 2
- 238000009987 spinning Methods 0.000 claims description 2
- 230000033001 locomotion Effects 0.000 abstract description 8
- 238000004891 communication Methods 0.000 abstract description 5
- 238000005516 engineering process Methods 0.000 description 4
- 230000000694 effects Effects 0.000 description 3
- 239000007787 solid Substances 0.000 description 3
- 238000010586 diagram Methods 0.000 description 2
- 229910000838 Al alloy Inorganic materials 0.000 description 1
- 239000000956 alloy Substances 0.000 description 1
- 230000008878 coupling Effects 0.000 description 1
- 238000010168 coupling process Methods 0.000 description 1
- 238000005859 coupling reaction Methods 0.000 description 1
- 230000007812 deficiency Effects 0.000 description 1
- 238000001514 detection method Methods 0.000 description 1
- 230000005611 electricity Effects 0.000 description 1
- 238000003306 harvesting Methods 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 239000000203 mixture Substances 0.000 description 1
- 230000002093 peripheral effect Effects 0.000 description 1
- 230000001105 regulatory effect Effects 0.000 description 1
- 230000003068 static effect Effects 0.000 description 1
Landscapes
- Length Measuring Devices By Optical Means (AREA)
- Optical Radar Systems And Details Thereof (AREA)
Abstract
本发明公开了一种激光发射装置及自动追踪方法，实现对移动中的激光接收器靶标的快速而准确的自动跟踪。所述激光发射装置包括激光安装平台和底架；所述激光安装平台包括用于发射调制激光信号的激光发射器，用于带动激光发射器旋转的激光发射器旋转机构，用于控制激光发射器旋转速度并自动追踪激光接收器的激光发射器旋转控制单元，用于激光发射器调平的自动调平机构和用于接收激光发射器转速数据并发射激光发射角度数据的通信单元；所述底架包括支撑整个激光安装平台的三脚架和用于激光安装平台升降的激光安装平台升降单元。
Description
技术领域
本发明属于自动定位技术领域，特别涉及一种激光发射装置及自动追踪方法。
背景技术
精确定位技术是实现农田作业机械自动驾驶和处方农业的基础技术之一，在农业机械对靶喷洒、精量施肥、收割测产、自动栽插等许多作业过程中有着广泛的用途，是现代智能农业机械研究的一个重要内容。由于激光具备体积小、重量轻、速度快以及误差小等优点，在建筑行业用于水平和垂直校准中应用极为广泛，但在定位方面的研究才刚起步。激光动态定位系统中，激光发射器发射激光信号并自动跟踪激光接收靶标中心，不出现脱靶现象，是激光三点动态定位系统正常工作的基础。目前市面上的激光发射装置均不能有效的自动追踪激光接收器，不适用于激光三点动态定位系统。
发明内容
本发明的目的是：为了克服现有技术的不足，本发明提供一种用于激光三点动态定位的激光发射装置及自动追踪方法，实现对移动中的激光接收器靶标的快速而准确的自动跟踪，为农田作业机械无人驾驶和田间数据定点采集奠定基础。
为了实现上述技术目的，本发明的技术方案是，一种用于自动追踪的激光发射装置，包括激光发射器、激光发射器姿态调整装置和控制盒，所述的激光发射器安装于激光发射器姿态调整装置上，所述的控制盒通信连接激光 发射器姿态调整装置以实现对激光发射器姿态的控制，激光发射器的控制端连接控制盒的输出端，所述的激光发射器姿态调整装置包括水平微调机构、激光发射器旋转机构和调平机构，所述的激光发射器安装于水平微调机构上，所述的激光发射器旋转机构连接水平微调机构以实现驱动激光发射器旋转，水平微调机构和激光发射器旋转机构均安装于调平机构上。
所述的一种用于自动追踪的激光发射装置，所述的调平机构包括底板、二升降步进电机、二丝杆、开有用于穿过丝杆的穿孔的连接板、二活动板、固定挡板、二限位传感器、三球头关节轴承、平台板、固定支杆、倾角传感器，所述的二升降步进电机和固定支杆均固定于底板上，所述的连接板水平固定于升降步进电机上，二丝杆的一端穿过连接板的穿孔分别连接二升降步进电机，另一端连接活动板，升降步进电机驱动丝杆旋转并带动活动板升降，所述的固定挡板竖直固定于连接板上以实现对活动板的导向，所述的二限位传感器水平固定于固定挡板上以实现对活动板的限位，所述的三球头关节轴承的一端分别固定于平台板的底部以支撑平台板，其中两个球头关节轴承的另一端分别固定于二活动板上，另一个球头关节轴承固定于固定支杆上，所述的倾角传感器固定于平台板上，控制盒固定于底板上，激光发射器旋转机构固定于平台板的底部，限位传感器、倾角传感器、升降步进电机和激光发射器旋转机构分别通信连接控制盒。
所述的一种用于自动追踪的激光发射装置，所述的水平微调机构包括水平调整支架和筒状的激光发射器安装孔，所述的激光发射器安装孔固定于水平调整支架上并用于固定激光发射器，所述的水平调整支架为双层互相垂直叠放的夹状的支架，两层支架的末端分别设有横向水平微调螺钉和纵向水平 微调螺钉，水平调整支架安装于平台板上且底部连接激光发射器旋转机构。
所述的一种用于自动追踪的激光发射装置，所述的激光发射器旋转机构为旋转步进电机。
一种自动追踪方法，包括以下步骤：
步骤一：设置两个固定位置的激光发射装置：第一激光发射装置和第二激光发射装置，在欲追踪的目标上设置激光接收器，两个激光发射装置分别作自旋转并发射激光，同时建立平面坐标系，定义两个激光发射装置之间的连线为基线，第一激光发射装置的坐标为（xA，yA），第二激光发射装置的坐标为（xB，yB）；
步骤二：当激光接收器同时接收到两个激光发射装置所分别发射的激光信号时，由通信单元反馈信息到激光发射装置的旋转控制单元，实时检测激光发射器的激光发射角度，并根据两个激光发射装置的坐标，解算当前激光接收器所在位置的坐标（x1，y1）；
步骤三：在解算出移动过程中的激光接收器至少三个位置坐标后，由已知的位置坐标值预估激光接收器的移动趋势；
步骤四：由预估得到的激光接收器移动趋势，计算对应的激光发射装置上的激光发射器所应旋转的角度，实时追踪激光接收器。
所述的方法，步骤二中所述的解算当前激光接收器所在位置的坐标（x1，y1）的步骤包括：
当激光接收器同时接收到两个激光发射装置所分别发射的激光信号时，定义此时第一激光发射装置与激光接收器的连线与基线的夹角为α，第二激光发射装置与激光接收器的连线与基线的夹角为β，通过以下公式计算激光 接收器的坐标（x1，y1）：
所述的方法，步骤三中所述的由已知的位置坐标值预估激光接收器的移动趋势的步骤包括：
设所解算出激光接收器的三个坐标分别为坐标1（x1，y1），坐标2（x2，y2），坐标3（x3，y3），通过以下公式计算坐标1至坐标2的直线斜率K12和坐标2至坐标3的斜率K23：
再采用以下公式求得位置坐标3至预估的位置坐标4的直线斜率K34：
则求得坐标4（x4，y4）为：
其中，v为激光接收器的移动速度，t为单位采样时间。
所述的方法，步骤四中所述的计算对应的激光发射装置上的激光发射器所应旋转的角度的步骤包括：
首先计算第一激光发射器与坐标3和坐标4的距离LA-3，LA-4，以及坐标 3至坐标4的距离L3-4，计算公式为：
再通过以下公式计算第一激光发射器所应旋转的角度θ为：
本发明的技术效果在于，相比以往技术，本发明通过自动调平机构，解决激光水平发射问题，通过定位坐标的解算，实现跟踪目标的速度计算与预估，并根据预估的速度，解算激光跟踪的预估旋转角速度，从而实现激光发射器对激光接收靶的自动跟踪。
附图说明
图1为本发明激光发射装置的结构示意图；
图2为本发明激光发射装置水平微调机构的结构示意图；
图3为本发明定位激光接收的示意图；
图4为本发明追踪目标的示意图，
其中1-活动板，2-固定挡板，3-连接板，4-底板，5-平台板，6-升降步进电机，7-旋转步进电机，8-球头关节轴承，9-支杆，10-控制盒，11-倾角传感器，12-激光发射器，13-限位传感器，14-水平微调机构，15-激光头安装孔，16-横向水平微调螺钉，17-水平调整支架，18-纵向水平微调螺钉。
具体实施方式
参见图1，本发明装置包括激光发射器、激光发射器姿态调整装置和控制盒，激光发射器安装于激光发射器姿态调整装置上，控制盒通信连接激光发 射器姿态调整装置以实现对激光发射器姿态的控制，激光发射器的控制端连接控制盒的输出端，激光发射器姿态调整装置包括水平微调机构、激光发射器旋转机构和调平机构，激光发射器安装于水平微调机构上，激光发射器旋转机构连接水平微调机构以实现驱动激光发射器旋转，水平微调机构和激光发射器旋转机构均安装于调平机构上。
调平机构包括底板、二升降步进电机、二丝杆、开有用于穿过丝杆的穿孔的连接板、二活动板、固定挡板、二限位传感器、三球头关节轴承、平台板、固定支杆、倾角传感器，二升降步进电机和固定支杆均固定于底板上，连接板水平固定于升降步进电机上，二丝杆的一端穿过连接板的穿孔分别连接二升降步进电机，另一端连接活动板，升降步进电机驱动丝杆旋转并带动活动板升降，固定挡板竖直固定于连接板上以实现对活动板的导向，二限位传感器水平固定于固定挡板上以实现对活动板的限位，三球头关节轴承的一端分别固定于平台板的底部以支撑平台板，其中两个球头关节轴承的另一端分别固定于二活动板上，另一个球头关节轴承固定于固定支杆上，倾角传感器固定于平台板上，控制盒固定于底板上，激光发射器旋转机构固定于平台板的底部，限位传感器、倾角传感器、升降步进电机和激光发射器旋转机构分别通信连接控制盒。其中激光发射器旋转机构为旋转步进电机。
在使用时，平台板的三个角由三个球头关节轴承支撑，控制两个球头关节轴承的升降可以实现对平台板的调整。球头关节轴承由一个磨成球面的内圈装在相匹配的外圈中组成，可以在一个小的区间里同时承受径向与轴向负荷，在静态和摆动应用中允许适中的偏斜。两个球头关节轴承分别连接于两块活动板上，另一个球头关节轴承固定在支杆上。倾角传感器安放在平台板 上，当平台板处于非水平状态，倾角传感器发出信号，由控制盒接收信号处理后控制升降步进电机旋转，升降步进电机的丝杆转动分别带动两块活动板上下运动，活动板在上下运动过程中沿着固定挡板移动，固定挡板能够起到导向作用，防止活动板在上下运动过程中随着丝杆一起转动。固定挡板上装有两个限位传感器，当活动板向下运动到限位传感器处时，限位传感器发出信号给控制盒，控制盒控制升降步进电机停止转动。当平台板最终调平后，再由倾角传感器发出信号给控制盒，控制盒控制步进电机停止转动，最终调平结束。
水平微调机构包括水平调整支架和筒状的激光发射器安装孔，激光发射器安装孔固定于水平调整支架上并用于固定激光发射器，水平调整支架为双层互相垂直叠放的夹状的支架，两层支架的末端分别设有横向水平微调螺钉和纵向水平微调螺钉，水平调整支架安装于平台板上且底部连接激光发射器旋转机构。
水平微调机构优选采用铝合金材料，主要由激光发射器安装孔和水平调整支架等构成。微调机构通过两组调节螺钉能够在横、纵两个方向上进行调平，每组调节螺钉各有三个微调螺钉，中间的微调螺钉用于控制平面的俯角，而两边的微调螺钉则用于控制平面的仰角的。同时，机构在两个水平气泡的配合下，调平精度能够达到±0.1’,满足系统精度的要求。水平微调机构通过联轴器与旋转步进电机轴相连，从而使旋转步进电机带动激光发射器旋转，形成激光扫描平面。
激光发射器优选普通镭射635nm的红外激光，通过发射器控制单元产生的38KHz载波信号作为定位用光源，激光发射器安装于激光发射器安装孔上， 由旋转步进电机组成的激光发射器跟踪旋转机构在发射器控制单元的控制下做360°跟踪旋转运动，用于追踪安装在运动机械上的激光接收器。
所述激光发射器发射的激光信号自动追踪激光接收器方法如下：
1）如图3所示，A、B分别为两个激光发射装置，其放置的位置坐标分别已知为（xA，yA）（xB，yB），追踪移动中的激光接收器，用于激光三点动态定位，以实时解算激光接收器当前所在位置坐标1（x1，y1）。
2）启动时，至少两个激光发射装置上的激光发射器在已知针对两个激光发射器旋转中心的基线对应的旋转角度后，由激光发射器旋转机构带动，采用360°旋转方式扫描搜索到激光接收器靶标水平方向对应的中心位置；
3）在激光接收器靶标接收到激光信号时，由通信单元反馈信息到激光发射装置的旋转控制单元，实时检测两个激光发射器的激光发射角度α、β，通过通信单元将数据传输至外设，根据激光三点动态定位原理，解算当前激光接收器所在位置的坐标1（x1，y1），具体公式如下：
4）如图4所示，解算出移动过程中的激光接收器至少三个位置坐标1（x1，y1），2（x2，y2），3（x3，y3）后，由已知的位置坐标值预估激光接收器的移动趋势点4（x4，y4）的坐标值，具体公式如下：
首先，计算位置坐标1至位置坐标2的直线斜率K12和位置坐标2至位置坐标3的直线斜率K23；
再采用拟合方式取位置坐标3至预估的位置坐标4的直线斜率K34；
由此得位置坐标4（x4，y4）为：
其中，v为激光接收器的移动速度，t为单位采样时间。
5）由预估得到的激光接收器移动趋势，计算对应的激光发射装置上的激光发射器所应旋转的角度θ，实时追踪激光接收器，具体公式如下：
首先分别计算激光发射器A至位置3与位置4的距离LA-3，LA-4，以及位置3至位置4的距离L3-4；
再计算得激光发射器所应旋转的角度θ为：
。
Claims (1)
1.一种自动追踪方法，其特征在于，包括以下步骤：
步骤一：设置两个固定位置的激光发射装置：第一激光发射装置和第二激光发射装置，在欲追踪的目标上设置激光接收器，两个激光发射装置分别作自旋转并发射激光，同时建立平面坐标系，定义两个激光发射装置之间的连线为基线，第一激光发射装置的坐标为(xA，yA)，第二激光发射装置的坐标为(xB，yB)；
步骤二：当激光接收器同时接收到两个激光发射装置所分别发射的激光信号时，由通信单元反馈信息到激光发射装置的旋转控制单元，实时检测激光发射器的激光发射角度，并根据两个激光发射装置的坐标，解算当前激光接收器所在位置的坐标(x1，y1)；
步骤三：在解算出移动过程中的激光接收器至少三个位置坐标后，由已知的位置坐标值预估激光接收器的移动趋势，找出所述激光接收器未来即将到达的一个移动趋势点；
步骤四：由预估得到的激光接收器的移动趋势点，计算对应的激光发射装置上的激光发射器所应旋转的角度，实时追踪激光接收器；
步骤二中所述的解算当前激光接收器所在位置的坐标(x1，y1)的步骤包括：
当激光接收器同时接收到两个激光发射装置所分别发射的激光信号时，定义此时第一激光发射装置与激光接收器的连线与基线的夹角为α，第二激光发射装置与激光接收器的连线与基线的夹角为β，通过以下公式计算激光接收器的坐标(x1，y1)：
<mrow>
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mi>x</mi>
<mn>1</mn>
</msub>
<mo>=</mo>
<mfrac>
<mrow>
<mi>t</mi>
<mi>a</mi>
<mi>n</mi>
<mi>&beta;</mi>
</mrow>
<mrow>
<mi>t</mi>
<mi>a</mi>
<mi>n</mi>
<mi>&alpha;</mi>
<mo>+</mo>
<mi>t</mi>
<mi>a</mi>
<mi>n</mi>
<mi>&beta;</mi>
</mrow>
</mfrac>
<mrow>
<mo>(</mo>
<msub>
<mi>x</mi>
<mi>B</mi>
</msub>
<mo>-</mo>
<msub>
<mi>x</mi>
<mi>A</mi>
</msub>
<mo>)</mo>
</mrow>
<mo>-</mo>
<mfrac>
<mrow>
<mi>t</mi>
<mi>a</mi>
<mi>n</mi>
<mi>&alpha;</mi>
<mo>&CenterDot;</mo>
<mi>t</mi>
<mi>a</mi>
<mi>n</mi>
<mi>&beta;</mi>
</mrow>
<mrow>
<mi>t</mi>
<mi>a</mi>
<mi>n</mi>
<mi>&alpha;</mi>
<mo>+</mo>
<mi>t</mi>
<mi>a</mi>
<mi>n</mi>
<mi>&beta;</mi>
</mrow>
</mfrac>
<mrow>
<mo>(</mo>
<msub>
<mi>y</mi>
<mi>B</mi>
</msub>
<mo>-</mo>
<msub>
<mi>y</mi>
<mi>A</mi>
</msub>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>y</mi>
<mn>1</mn>
</msub>
<mo>=</mo>
<mfrac>
<mrow>
<mi>t</mi>
<mi>a</mi>
<mi>n</mi>
<mi>&alpha;</mi>
<mo>&CenterDot;</mo>
<mi>t</mi>
<mi>a</mi>
<mi>n</mi>
<mi>&beta;</mi>
</mrow>
<mrow>
<mi>t</mi>
<mi>a</mi>
<mi>n</mi>
<mi>&alpha;</mi>
<mo>+</mo>
<mi>t</mi>
<mi>a</mi>
<mi>n</mi>
<mi>&beta;</mi>
</mrow>
</mfrac>
<mrow>
<mo>(</mo>
<msub>
<mi>x</mi>
<mi>B</mi>
</msub>
<mo>-</mo>
<msub>
<mi>x</mi>
<mi>A</mi>
</msub>
<mo>)</mo>
</mrow>
<mo>+</mo>
<mfrac>
<mrow>
<mi>tan</mi>
<mi>&beta;</mi>
</mrow>
<mrow>
<mi>t</mi>
<mi>a</mi>
<mi>n</mi>
<mi>&alpha;</mi>
<mo>+</mo>
<mi>t</mi>
<mi>a</mi>
<mi>n</mi>
<mi>&beta;</mi>
</mrow>
</mfrac>
<mrow>
<mo>(</mo>
<msub>
<mi>y</mi>
<mi>B</mi>
</msub>
<mo>-</mo>
<msub>
<mi>y</mi>
<mi>A</mi>
</msub>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>;</mo>
</mrow>
步骤三中所述的由已知的位置坐标值预估激光接收器的移动趋势的步骤包括：
设所解算出激光接收器的三个坐标分别为坐标1(x1，y1)，坐标2(x2，y2)，坐标3(x3，y3)，通过以下公式计算坐标1至坐标2的直线斜率K12和坐标2至坐标3的斜率K23：
<mrow>
<msub>
<mi>K</mi>
<mn>12</mn>
</msub>
<mo>=</mo>
<mfrac>
<mrow>
<msub>
<mi>y</mi>
<mn>2</mn>
</msub>
<mo>-</mo>
<msub>
<mi>y</mi>
<mn>1</mn>
</msub>
</mrow>
<mrow>
<msub>
<mi>x</mi>
<mn>2</mn>
</msub>
<mo>-</mo>
<msub>
<mi>x</mi>
<mn>1</mn>
</msub>
</mrow>
</mfrac>
<mo>,</mo>
</mrow>
<mrow>
<msub>
<mi>K</mi>
<mn>23</mn>
</msub>
<mo>=</mo>
<mfrac>
<mrow>
<msub>
<mi>y</mi>
<mn>3</mn>
</msub>
<mo>-</mo>
<msub>
<mi>y</mi>
<mn>2</mn>
</msub>
</mrow>
<mrow>
<msub>
<mi>x</mi>
<mn>3</mn>
</msub>
<mo>-</mo>
<msub>
<mi>x</mi>
<mn>2</mn>
</msub>
</mrow>
</mfrac>
<mo>;</mo>
</mrow>
再采用以下公式求得位置坐标3至预估的位置坐标4的直线斜率K34：
<mrow>
<msub>
<mi>K</mi>
<mn>34</mn>
</msub>
<mo>=</mo>
<mfrac>
<mn>1</mn>
<mn>2</mn>
</mfrac>
<mrow>
<mo>(</mo>
<msub>
<mi>K</mi>
<mn>12</mn>
</msub>
<mo>+</mo>
<msub>
<mi>K</mi>
<mn>23</mn>
</msub>
<mo>)</mo>
</mrow>
<mo>;</mo>
</mrow>
则求得坐标4(x4，y4)为：
<mrow>
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mi>x</mi>
<mn>4</mn>
</msub>
<mo>=</mo>
<mi>v</mi>
<mi>t</mi>
<mo>&CenterDot;</mo>
<msqrt>
<mfrac>
<mn>1</mn>
<mrow>
<mn>1</mn>
<mo>+</mo>
<msup>
<msub>
<mi>k</mi>
<mn>34</mn>
</msub>
<mn>2</mn>
</msup>
</mrow>
</mfrac>
</msqrt>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>y</mi>
<mn>4</mn>
</msub>
<mo>=</mo>
<mi>v</mi>
<mi>t</mi>
<mo>&CenterDot;</mo>
<msqrt>
<mrow>
<mn>1</mn>
<mo>-</mo>
<mfrac>
<mn>1</mn>
<mrow>
<mn>1</mn>
<mo>+</mo>
<msup>
<msub>
<mi>k</mi>
<mn>34</mn>
</msub>
<mn>2</mn>
</msup>
</mrow>
</mfrac>
</mrow>
</msqrt>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>,</mo>
</mrow>
其中，v为激光接收器的移动速度，t为单位采样时间；
步骤四中所述的计算对应的激光发射装置上的激光发射器所应旋转的角度的步骤包括：
首先计算第一激光发射器与坐标3和坐标4的距离LA-3，LA-4，以及坐标3至坐标4的距离L3-4，计算公式为：
<mrow>
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mi>L</mi>
<mrow>
<mi>A</mi>
<mo>-</mo>
<mn>3</mn>
</mrow>
</msub>
<mo>=</mo>
<msqrt>
<mrow>
<msup>
<mrow>
<mo>(</mo>
<msub>
<mi>x</mi>
<mn>3</mn>
</msub>
<mo>-</mo>
<msub>
<mi>x</mi>
<mi>A</mi>
</msub>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
<mo>+</mo>
<msup>
<mrow>
<mo>(</mo>
<msub>
<mi>y</mi>
<mn>3</mn>
</msub>
<mo>-</mo>
<msub>
<mi>y</mi>
<mi>A</mi>
</msub>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
</mrow>
</msqrt>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>L</mi>
<mrow>
<mi>A</mi>
<mo>-</mo>
<mn>4</mn>
</mrow>
</msub>
<mo>=</mo>
<msqrt>
<mrow>
<msup>
<mrow>
<mo>(</mo>
<msub>
<mi>x</mi>
<mn>4</mn>
</msub>
<mo>-</mo>
<msub>
<mi>x</mi>
<mi>A</mi>
</msub>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
<mo>+</mo>
<msup>
<mrow>
<mo>(</mo>
<msub>
<mi>y</mi>
<mn>4</mn>
</msub>
<mo>-</mo>
<msub>
<mi>y</mi>
<mi>A</mi>
</msub>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
</mrow>
</msqrt>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>L</mi>
<mrow>
<mn>3</mn>
<mo>-</mo>
<mn>4</mn>
</mrow>
</msub>
<mo>=</mo>
<msqrt>
<mrow>
<msup>
<mrow>
<mo>(</mo>
<msub>
<mi>x</mi>
<mn>4</mn>
</msub>
<mo>-</mo>
<msub>
<mi>x</mi>
<mn>3</mn>
</msub>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
<mo>+</mo>
<msup>
<mrow>
<mo>(</mo>
<msub>
<mi>y</mi>
<mn>4</mn>
</msub>
<mo>-</mo>
<msub>
<mi>y</mi>
<mn>3</mn>
</msub>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
</mrow>
</msqrt>
<mo>=</mo>
<mi>v</mi>
<mi>t</mi>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>,</mo>
</mrow>
再通过以下公式计算第一激光发射器所应旋转的角度θ为：
<mrow>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mi>&theta;</mi>
<mo>=</mo>
<mfrac>
<mrow>
<msubsup>
<mi>L</mi>
<mrow>
<mi>A</mi>
<mo>-</mo>
<mn>3</mn>
</mrow>
<mn>2</mn>
</msubsup>
<mo>+</mo>
<msubsup>
<mi>L</mi>
<mrow>
<mi>A</mi>
<mo>-</mo>
<mn>4</mn>
</mrow>
<mn>2</mn>
</msubsup>
<mo>+</mo>
<msubsup>
<mi>L</mi>
<mrow>
<mn>3</mn>
<mo>-</mo>
<mn>4</mn>
</mrow>
<mn>2</mn>
</msubsup>
</mrow>
<mrow>
<mn>2</mn>
<mo>&CenterDot;</mo>
<msub>
<mi>L</mi>
<mrow>
<mi>A</mi>
<mo>-</mo>
<mn>3</mn>
</mrow>
</msub>
<mo>&CenterDot;</mo>
<msub>
<mi>L</mi>
<mrow>
<mi>A</mi>
<mo>-</mo>
<mn>4</mn>
</mrow>
</msub>
</mrow>
</mfrac>
<mo>.</mo>
</mrow>
2
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201310269008.3A CN103345269B (zh) | 2013-06-30 | 2013-06-30 | 一种激光发射装置及自动追踪方法 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201310269008.3A CN103345269B (zh) | 2013-06-30 | 2013-06-30 | 一种激光发射装置及自动追踪方法 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN103345269A CN103345269A (zh) | 2013-10-09 |
| CN103345269B true CN103345269B (zh) | 2017-08-25 |
Family
ID=49280072
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201310269008.3A Expired - Fee Related CN103345269B (zh) | 2013-06-30 | 2013-06-30 | 一种激光发射装置及自动追踪方法 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN103345269B (zh) |
Families Citing this family (13)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN104613935B (zh) * | 2015-01-23 | 2017-01-11 | 山东大学 | 用于隧道检测的可伸缩式自动调平轨道系统及其使用方法 |
| CN106443609B (zh) * | 2016-11-21 | 2018-10-19 | 成都蓉威电子技术有限公司 | 一种角度随动监测系统及方法 |
| CN107037412B (zh) * | 2016-11-21 | 2018-12-25 | 成都蓉威电子技术有限公司 | 一种角度自动测量系统及方法 |
| CN106802412B (zh) * | 2017-01-23 | 2020-08-04 | 南京大学 | 一种基于激光及无线技术的近距离移动定位系统及其方法 |
| CN109387826B (zh) * | 2017-08-04 | 2024-03-19 | 美国西北仪器公司 | 测量角度、距离的方法、绘制轨迹图方法及激光测距系统 |
| CN107765609A (zh) * | 2017-12-05 | 2018-03-06 | 吉林壁虎工程机械制造有限公司 | 一种激光发射器、激光接收器以及激光整平机 |
| CN107990884A (zh) * | 2017-12-19 | 2018-05-04 | 淮阴工学院 | 一种用于汽车引擎盖检测的均匀取点装置及检测方法 |
| CN108153011B (zh) * | 2018-02-07 | 2021-03-12 | 京东方科技集团股份有限公司 | 一种光学检测装置及其控制方法 |
| CN110109057B (zh) * | 2019-04-24 | 2021-04-20 | 广州市慧建科技有限公司 | 一种激光定位系统 |
| CN110166653B (zh) * | 2019-06-21 | 2021-04-06 | 深圳迪乐普数码科技有限公司 | 摄像机位置和姿态的跟踪系统及方法 |
| CN110333186B (zh) * | 2019-07-05 | 2023-04-07 | 广州市锐博生物科技有限公司 | 调节装置、调节系统、调节方法和调节控制装置 |
| CN110207626A (zh) * | 2019-07-18 | 2019-09-06 | 北京无线电测量研究所 | 一种平面度的激光测量装置及方法 |
| CN114354206B (zh) * | 2021-07-19 | 2024-07-12 | 襄阳达安汽车检测中心有限公司 | 一种三轴校准杆 |
Citations (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN2345950Y (zh) * | 1998-08-27 | 1999-10-27 | 力洁科技有限公司 | 一种激光水平仪 |
| CN1362692A (zh) * | 2002-02-07 | 2002-08-07 | 天津大学 | 六自由度测量功能的激光扫描跟踪仪 |
| CN101672913A (zh) * | 2009-10-27 | 2010-03-17 | 湖南农业大学 | 激光三点动态定位方法及系统 |
| CN203311264U (zh) * | 2013-06-30 | 2013-11-27 | 湖南农业大学 | 一种激光发射装置 |
Family Cites Families (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US8619265B2 (en) * | 2011-03-14 | 2013-12-31 | Faro Technologies, Inc. | Automatic measurement of dimensional data with a laser tracker |
-
2013
- 2013-06-30 CN CN201310269008.3A patent/CN103345269B/zh not_active Expired - Fee Related
Patent Citations (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN2345950Y (zh) * | 1998-08-27 | 1999-10-27 | 力洁科技有限公司 | 一种激光水平仪 |
| CN1362692A (zh) * | 2002-02-07 | 2002-08-07 | 天津大学 | 六自由度测量功能的激光扫描跟踪仪 |
| CN101672913A (zh) * | 2009-10-27 | 2010-03-17 | 湖南农业大学 | 激光三点动态定位方法及系统 |
| CN203311264U (zh) * | 2013-06-30 | 2013-11-27 | 湖南农业大学 | 一种激光发射装置 |
Also Published As
| Publication number | Publication date |
|---|---|
| CN103345269A (zh) | 2013-10-09 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN103345269B (zh) | 一种激光发射装置及自动追踪方法 | |
| CN101672913B (zh) | 激光三点动态定位方法及系统 | |
| CN109720609B (zh) | 一种悬吊式微重力模拟装置及控制方法 | |
| CN110241696B (zh) | 移动式高精度测量机器人系统及其测量方法 | |
| CN102999048B (zh) | 一种车载动基座光电搜索跟踪转台的伺服控制方法 | |
| CN103743338B (zh) | 具有球面回转跳动误差补偿功能的激光跟踪测量系统及其补偿方法 | |
| CN111189436B (zh) | 基于激光靶向跟踪的掘进机位姿测量系统 | |
| CN107340776B (zh) | 一种全方位智能跟随行李箱及其控制方法 | |
| CN104362947B (zh) | 一种高精度太阳光跟踪系统及其控制方法 | |
| CN206627632U (zh) | 一种激光云台智能空间定位系统 | |
| CN106842229A (zh) | 一种激光云台智能空间定位系统及空间定位方法 | |
| CN207163422U (zh) | 一种管片自动识别抓取装置 | |
| CN106379409A (zh) | 角度可控动力差速全向轮及其控制方法以及全向移动平台 | |
| CN106527484B (zh) | 一种基于机电一体化的无人机飞行航线管理系统 | |
| CN107490375A (zh) | 定点悬停精度测量装置、方法及无人飞行器 | |
| KR100836870B1 (ko) | 광센서를 이용한 원통형 태양추적장치 및 이를 이용한태양전지 구동 시스템 | |
| WO2022062375A1 (zh) | 一种具有纠偏作用的施工放线机器人及工作方法 | |
| CN105737735A (zh) | 便携式自校准末端执行器重复定位精度测量装置及方法 | |
| CN110374154A (zh) | 一种单gps平地机铲刀高程控制装置及控制方法 | |
| CN114148536B (zh) | 一种用于光电吊舱的线位移补偿控制方法 | |
| CN112904861B (zh) | 基于被动式正交全向轮的移动机器人二维定位装置及方法 | |
| CN114739304A (zh) | 一种环境艺术设计用定位测距装置 | |
| CN203311264U (zh) | 一种激光发射装置 | |
| CN108333611A (zh) | 一种惯性导航辅助的带缺区双反射面的卫星天线 | |
| WO2023065471A1 (zh) | 一种光伏组件清扫机器人的运输装置及方法 |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| C06 | Publication | ||
| PB01 | Publication | ||
| C10 | Entry into substantive examination | ||
| SE01 | Entry into force of request for substantive examination | ||
| GR01 | Patent grant | ||
| GR01 | Patent grant | ||
| CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20170825 |
|
| CF01 | Termination of patent right due to non-payment of annual fee |