发明名称 一种非接触式物体平面运动测量装置及实现方法
摘要 本发明公开物体平面运动测量装置及实现方法,具体地说是一种利用激光测距传感器来测量物体平面运动的测量装置;该平面运动测量装置利用三个激光测距传感器,通过测量组合算法,实现了物体平面运动的非接触式测量,消除了测量装置自身运动对被测系统运动的干扰;本发明装置结合测量组合算法具有测量精度高,结构简单,安装方便,便于维护的优点。
申请公布号 CN103808256B 申请公布日期 2016.12.21
申请号 CN201210460904.3 申请日期 2012.11.15
申请人 中国科学院沈阳自动化研究所 发明人 徐志刚;王军义;贺云;徐永利;刘勇
分类号 G01B11/00(2006.01)I;G01B11/03(2006.01)I;G01B11/26(2006.01)I 主分类号 G01B11/00(2006.01)I
代理机构 沈阳科苑专利商标代理有限公司 21002 代理人 许宗富
主权项 一种非接触式物体平面运动测量装置,其特征在于:它包括基座(1)、第1激光测距传感器(2)、第2激光测距传感器(3)和第3激光测距传感器(4),第1~3激光测距传感器分别垂直布置安装在基座(1)上,在基座(1)X向安装第2激光测距传感器(3)和第3激光测距传感器(4),在Y向安装第1激光测距传感器(2);通过第1~3激光测距传感器测量被测物体(5)距离第1~3激光测距传感器的距离值,通过组合测量算法处理,实现了物体平面运动的非接触式测量;组合测量算法如下:第2激光测距传感器(3)和第3激光测距传感器(4)在X向的位置为坐标系X轴上两已知点a<sub>1</sub>(x<sub>1</sub>,0),a<sub>2</sub>(x<sub>2</sub>,0),第1激光测距传感器(2)在Y向的位置为坐标系Y轴上已知一点b(0,y<sub>1</sub>),点u、v、w分别为在某时刻第2激光测距传感器(3)、第3激光测距传感器(4)、第1激光测距传感器(2)的测量点,点o<sub>1</sub>为被测物体质心点在平面XOY的投影点,取第2激光测距传感器(3)测量值为l<sub>1</sub>,第3激光测距传感器(4)测量值为l<sub>2</sub>,第1激光测距传感器(2)测量值为l<sub>3</sub>,则u、v、w三点的坐标分别为(x<sub>1</sub>,l<sub>1</sub>)、(x<sub>2</sub>,l<sub>2</sub>)、(l<sub>3</sub>,y<sub>1</sub>),点O<sub>2</sub>和点O<sub>3</sub>为被测物体在平面XOY上的投影边线的顶点且点u、v位于直线O<sub>2</sub>O<sub>3</sub>上,点O<sub>2</sub>和点O<sub>4</sub>为被测物体在平面XOY上的另一条投影边线的顶点且点w位于直线O<sub>2</sub>O<sub>4</sub>上;根据u、v、w三点坐标及交点O<sub>2</sub>、O<sub>3</sub>、O<sub>4</sub>的坐标以及O<sub>2</sub>O<sub>3</sub>⊥O<sub>2</sub>O<sub>4</sub>的关系可求直线O<sub>2</sub>O<sub>3</sub>和O<sub>2</sub>O<sub>4</sub>的方程:<maths num="0001"><math><![CDATA[<mrow><mi>y</mi><mo>=</mo><mfrac><mrow><msub><mi>l</mi><mn>2</mn></msub><mo>-</mo><msub><mi>l</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><mi>x</mi><mo>-</mo><mfrac><mrow><msub><mi>l</mi><mn>2</mn></msub><mo>-</mo><msub><mi>l</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><msub><mi>x</mi><mn>1</mn></msub><mo>+</mo><msub><mi>l</mi><mn>1</mn></msub><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>1</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0001110193150000011.GIF" wi="1038" he="167" /></maths><maths num="0002"><math><![CDATA[<mrow><mi>y</mi><mo>=</mo><mfrac><mrow><msub><mi>x</mi><mn>1</mn></msub><mo>-</mo><msub><mi>x</mi><mn>2</mn></msub></mrow><mrow><msub><mi>l</mi><mn>2</mn></msub><mo>-</mo><msub><mi>l</mi><mn>1</mn></msub></mrow></mfrac><mi>x</mi><mo>-</mo><mfrac><mrow><msub><mi>x</mi><mn>1</mn></msub><mo>-</mo><msub><mi>x</mi><mn>2</mn></msub></mrow><mrow><msub><mi>l</mi><mn>2</mn></msub><mo>-</mo><msub><mi>l</mi><mn>1</mn></msub></mrow></mfrac><msub><mi>l</mi><mn>3</mn></msub><mo>+</mo><msub><mi>y</mi><mn>1</mn></msub><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>2</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0001110193150000012.GIF" wi="1142" he="143" /></maths>解上方程组得交点O<sub>2</sub>的坐标:<maths num="0003"><math><![CDATA[<mrow><mi>x</mi><mo>=</mo><mfrac><mrow><msub><mi>x</mi><mn>1</mn></msub><msup><mrow><mo>(</mo><msub><mi>l</mi><mn>1</mn></msub><mo>-</mo><msub><mi>l</mi><mn>2</mn></msub><mo>)</mo></mrow><mn>2</mn></msup><mo>+</mo><msub><mi>l</mi><mn>3</mn></msub><msup><mrow><mo>(</mo><msub><mi>x</mi><mn>1</mn></msub><mo>-</mo><msub><mi>x</mi><mn>2</mn></msub><mo>)</mo></mrow><mn>2</mn></msup><mo>+</mo><mrow><mo>(</mo><msub><mi>y</mi><mn>1</mn></msub><mo>-</mo><msub><mi>l</mi><mn>1</mn></msub><mo>)</mo></mrow><mrow><mo>(</mo><msub><mi>x</mi><mn>1</mn></msub><mo>-</mo><msub><mi>x</mi><mn>2</mn></msub><mo>)</mo></mrow><mrow><mo>(</mo><msub><mi>l</mi><mn>1</mn></msub><mo>-</mo><msub><mi>l</mi><mn>2</mn></msub><mo>)</mo></mrow></mrow><mrow><msup><mrow><mo>(</mo><msub><mi>x</mi><mn>1</mn></msub><mo>-</mo><msub><mi>x</mi><mn>2</mn></msub><mo>)</mo></mrow><mn>2</mn></msup><mo>+</mo><msup><mrow><mo>(</mo><msub><mi>l</mi><mn>1</mn></msub><mo>-</mo><msub><mi>l</mi><mn>2</mn></msub><mo>)</mo></mrow><mn>2</mn></msup></mrow></mfrac></mrow>]]></math><img file="FDA0001110193150000013.GIF" wi="1155" he="174" /></maths><maths num="0004"><math><![CDATA[<mrow><mi>y</mi><mo>=</mo><mfrac><mrow><mo>(</mo><msub><mi>l</mi><mn>3</mn></msub><mo>-</mo><msub><mi>x</mi><mn>1</mn></msub><mo>)</mo><mo>(</mo><msub><mi>x</mi><mn>1</mn></msub><mo>-</mo><msub><mi>x</mi><mn>2</mn></msub><mo>)</mo><mo>(</mo><msub><mi>l</mi><mn>1</mn></msub><mo>-</mo><msub><mi>l</mi><mn>2</mn></msub><mo>)</mo><mo>+</mo><mo>(</mo><msub><mi>y</mi><mn>1</mn></msub><mo>-</mo><msub><mi>l</mi><mn>1</mn></msub><mo>)</mo><msup><mrow><mo>(</mo><msub><mi>l</mi><mn>1</mn></msub><mo>-</mo><msub><mi>l</mi><mn>2</mn></msub><mo>)</mo></mrow><mn>2</mn></msup></mrow><mrow><msup><mrow><mo>(</mo><msub><mi>x</mi><mn>1</mn></msub><mo>-</mo><msub><mi>x</mi><mn>2</mn></msub><mo>)</mo></mrow><mn>2</mn></msup><mo>+</mo><msup><mrow><mo>(</mo><msub><mi>l</mi><mn>1</mn></msub><mo>-</mo><msub><mi>l</mi><mn>2</mn></msub><mo>)</mo></mrow><mn>2</mn></msup></mrow></mfrac><mo>+</mo><msub><mi>l</mi><mn>1</mn></msub></mrow>]]></math><img file="FDA0001110193150000014.GIF" wi="1222" he="199" /></maths>由交点O<sub>2</sub>的坐标、交点O<sub>1</sub>与交点O<sub>2</sub>线段间的已知距离、直线O<sub>1</sub>O<sub>2</sub>与直线O<sub>2</sub>O<sub>3</sub>间的夹角为<img file="FDA0001110193150000021.GIF" wi="75" he="121" />可求得被测物体质心在测量平面投影点O<sub>1</sub>的坐标为:<maths num="0005"><math><![CDATA[<mrow><mi>x</mi><mo>=</mo><mfrac><mrow><msub><mi>x</mi><mn>1</mn></msub><msup><mrow><mo>(</mo><msub><mi>l</mi><mn>1</mn></msub><mo>-</mo><msub><mi>l</mi><mn>2</mn></msub><mo>)</mo></mrow><mn>2</mn></msup><mo>+</mo><msub><mi>l</mi><mn>3</mn></msub><msup><mrow><mo>(</mo><msub><mi>x</mi><mn>1</mn></msub><mo>-</mo><msub><mi>x</mi><mn>2</mn></msub><mo>)</mo></mrow><mn>2</mn></msup><mo>+</mo><mrow><mo>(</mo><msub><mi>y</mi><mn>1</mn></msub><mo>-</mo><msub><mi>l</mi><mn>1</mn></msub><mo>)</mo></mrow><mrow><mo>(</mo><msub><mi>x</mi><mn>1</mn></msub><mo>-</mo><msub><mi>x</mi><mn>2</mn></msub><mo>)</mo></mrow><mrow><mo>(</mo><msub><mi>l</mi><mn>1</mn></msub><mo>-</mo><msub><mi>l</mi><mn>2</mn></msub><mo>)</mo></mrow></mrow><mrow><msup><mrow><mo>(</mo><msub><mi>x</mi><mn>1</mn></msub><mo>-</mo><msub><mi>x</mi><mn>2</mn></msub><mo>)</mo></mrow><mn>2</mn></msup><mo>+</mo><msup><mrow><mo>(</mo><msub><mi>l</mi><mn>1</mn></msub><mo>-</mo><msub><mi>l</mi><mn>2</mn></msub><mo>)</mo></mrow><mn>2</mn></msup></mrow></mfrac><mo>+</mo><mo>|</mo><msub><mi>o</mi><mn>1</mn></msub><msub><mi>o</mi><mn>2</mn></msub><mo>|</mo><mi>cos</mi><mrow><mo>(</mo><mi>&theta;</mi><mo>+</mo><mi>arctan</mi><mfrac><mrow><msub><mi>l</mi><mn>1</mn></msub><mo>-</mo><msub><mi>l</mi><mn>2</mn></msub></mrow><mrow><msub><mi>x</mi><mn>1</mn></msub><mo>-</mo><msub><mi>x</mi><mn>2</mn></msub></mrow></mfrac><mo>)</mo></mrow></mrow>]]></math><img file="FDA0001110193150000022.GIF" wi="1611" he="156" /></maths><maths num="0006"><math><![CDATA[<mrow><mi>y</mi><mo>=</mo><mfrac><mrow><mo>(</mo><msub><mi>l</mi><mn>3</mn></msub><mo>-</mo><msub><mi>x</mi><mn>1</mn></msub><mo>)</mo><mo>(</mo><msub><mi>x</mi><mn>1</mn></msub><mo>-</mo><msub><mi>x</mi><mn>2</mn></msub><mo>)</mo><mo>(</mo><msub><mi>l</mi><mn>1</mn></msub><mo>-</mo><msub><mi>l</mi><mn>2</mn></msub><mo>)</mo><mo>+</mo><mo>(</mo><msub><mi>y</mi><mn>1</mn></msub><mo>-</mo><msub><mi>l</mi><mn>1</mn></msub><mo>)</mo><msup><mrow><mo>(</mo><msub><mi>l</mi><mn>1</mn></msub><mo>-</mo><msub><mi>l</mi><mn>2</mn></msub><mo>)</mo></mrow><mn>2</mn></msup></mrow><mrow><msup><mrow><mo>(</mo><msub><mi>x</mi><mn>1</mn></msub><mo>-</mo><msub><mi>x</mi><mn>2</mn></msub><mo>)</mo></mrow><mn>2</mn></msup><mo>+</mo><msup><mrow><mo>(</mo><msub><mi>l</mi><mn>1</mn></msub><mo>-</mo><msub><mi>l</mi><mn>2</mn></msub><mo>)</mo></mrow><mn>2</mn></msup></mrow></mfrac><mo>+</mo><msub><mi>l</mi><mn>1</mn></msub><mo>+</mo><mo>|</mo><msub><mi>o</mi><mn>1</mn></msub><msub><mi>o</mi><mn>2</mn></msub><mo>|</mo><mi>s</mi><mi>i</mi><mi>n</mi><mrow><mo>(</mo><mi>&theta;</mi><mo>+</mo><mi>a</mi><mi>r</mi><mi>c</mi><mi>t</mi><mi>a</mi><mi>n</mi><mfrac><mrow><msub><mi>l</mi><mn>1</mn></msub><mo>-</mo><msub><mi>l</mi><mn>2</mn></msub></mrow><mrow><msub><mi>x</mi><mn>1</mn></msub><mo>-</mo><msub><mi>x</mi><mn>2</mn></msub></mrow></mfrac><mo>)</mo></mrow></mrow>]]></math><img file="FDA0001110193150000023.GIF" wi="1619" he="159" /></maths>经组合测量算法计算,解算出所设计的第1~3激光测距传感器组成的非接触式组合激光测距传感器相对于安装基座的X向、Y向位移和绕Z轴的转动运动参数,所测的值分别为:<maths num="0007"><math><![CDATA[<mrow><mi>x</mi><mo>=</mo><mfrac><mrow><msub><mi>x</mi><mn>1</mn></msub><msup><mrow><mo>(</mo><msub><mi>l</mi><mn>1</mn></msub><mo>-</mo><msub><mi>l</mi><mn>2</mn></msub><mo>)</mo></mrow><mn>2</mn></msup><mo>+</mo><msub><mi>l</mi><mn>3</mn></msub><msup><mrow><mo>(</mo><msub><mi>x</mi><mn>1</mn></msub><mo>-</mo><msub><mi>x</mi><mn>2</mn></msub><mo>)</mo></mrow><mn>2</mn></msup><mo>+</mo><mrow><mo>(</mo><msub><mi>y</mi><mn>1</mn></msub><mo>-</mo><msub><mi>l</mi><mn>1</mn></msub><mo>)</mo></mrow><mrow><mo>(</mo><msub><mi>x</mi><mn>1</mn></msub><mo>-</mo><msub><mi>x</mi><mn>2</mn></msub><mo>)</mo></mrow><mrow><mo>(</mo><msub><mi>l</mi><mn>1</mn></msub><mo>-</mo><msub><mi>l</mi><mn>2</mn></msub><mo>)</mo></mrow></mrow><mrow><msup><mrow><mo>(</mo><msub><mi>x</mi><mn>1</mn></msub><mo>-</mo><msub><mi>x</mi><mn>2</mn></msub><mo>)</mo></mrow><mn>2</mn></msup><mo>+</mo><msup><mrow><mo>(</mo><msub><mi>l</mi><mn>1</mn></msub><mo>-</mo><msub><mi>l</mi><mn>2</mn></msub><mo>)</mo></mrow><mn>2</mn></msup></mrow></mfrac><mo>+</mo><mo>|</mo><msub><mi>o</mi><mn>1</mn></msub><msub><mi>o</mi><mn>2</mn></msub><mo>|</mo><mi>c</mi><mi>o</mi><mi>s</mi><mrow><mo>(</mo><mi>&theta;</mi><mo>+</mo><mi>a</mi><mi>r</mi><mi>c</mi><mi>t</mi><mi>a</mi><mi>n</mi><mfrac><mrow><msub><mi>l</mi><mn>1</mn></msub><mo>-</mo><msub><mi>l</mi><mn>2</mn></msub></mrow><mrow><msub><mi>x</mi><mn>1</mn></msub><mo>-</mo><msub><mi>x</mi><mn>2</mn></msub></mrow></mfrac><mo>)</mo></mrow></mrow>]]></math><img file="FDA0001110193150000024.GIF" wi="1612" he="151" /></maths><maths num="0008"><math><![CDATA[<mrow><mi>y</mi><mo>=</mo><mfrac><mrow><mo>(</mo><msub><mi>l</mi><mn>3</mn></msub><mo>-</mo><msub><mi>x</mi><mn>1</mn></msub><mo>)</mo><mo>(</mo><msub><mi>x</mi><mn>1</mn></msub><mo>-</mo><msub><mi>x</mi><mn>2</mn></msub><mo>)</mo><mo>(</mo><msub><mi>l</mi><mn>1</mn></msub><mo>-</mo><msub><mi>l</mi><mn>2</mn></msub><mo>)</mo><mo>+</mo><mo>(</mo><msub><mi>y</mi><mn>1</mn></msub><mo>-</mo><msub><mi>l</mi><mn>1</mn></msub><mo>)</mo><msup><mrow><mo>(</mo><msub><mi>l</mi><mn>1</mn></msub><mo>-</mo><msub><mi>l</mi><mn>2</mn></msub><mo>)</mo></mrow><mn>2</mn></msup></mrow><mrow><msup><mrow><mo>(</mo><msub><mi>x</mi><mn>1</mn></msub><mo>-</mo><msub><mi>x</mi><mn>2</mn></msub><mo>)</mo></mrow><mn>2</mn></msup><mo>+</mo><msup><mrow><mo>(</mo><msub><mi>l</mi><mn>1</mn></msub><mo>-</mo><msub><mi>l</mi><mn>2</mn></msub><mo>)</mo></mrow><mn>2</mn></msup></mrow></mfrac><mo>+</mo><msub><mi>l</mi><mn>1</mn></msub><mo>+</mo><mo>|</mo><msub><mi>o</mi><mn>1</mn></msub><msub><mi>o</mi><mn>2</mn></msub><mo>|</mo><mi>s</mi><mi>i</mi><mi>n</mi><mrow><mo>(</mo><mi>&theta;</mi><mo>+</mo><mi>a</mi><mi>r</mi><mi>c</mi><mi>t</mi><mi>a</mi><mi>n</mi><mfrac><mrow><msub><mi>l</mi><mn>1</mn></msub><mo>-</mo><msub><mi>l</mi><mn>2</mn></msub></mrow><mrow><msub><mi>x</mi><mn>1</mn></msub><mo>-</mo><msub><mi>x</mi><mn>2</mn></msub></mrow></mfrac><mo>)</mo></mrow></mrow>]]></math><img file="FDA0001110193150000025.GIF" wi="1622" he="162" /></maths><maths num="0009"><math><![CDATA[<mrow><mi>&theta;</mi><mo>=</mo><mi>a</mi><mi>r</mi><mi>c</mi><mi>t</mi><mi>a</mi><mi>n</mi><mfrac><mrow><msub><mi>l</mi><mn>1</mn></msub><mo>-</mo><msub><mi>l</mi><mn>2</mn></msub></mrow><mrow><msub><mi>x</mi><mn>1</mn></msub><mo>-</mo><msub><mi>x</mi><mn>2</mn></msub></mrow></mfrac><mo>;</mo></mrow>]]></math><img file="FDA0001110193150000026.GIF" wi="389" he="131" /></maths>式中,x,y为被测物体相对基座(1)的X、Y轴的两个方向平动值,θ为物体绕垂直轴Z转动的角度值。
地址 110016 辽宁省沈阳市沈河区南塔街114号