发明名称 一种物体体积快速测量方法
摘要 本发明提供一种利用单目视觉定位原理和二维激光扫描仪测量物体体积的方法。技术方案是:将单目视觉定位系统与二维激光扫描仪架设于轮式车辆任意一侧,轮式车辆绕行物体一周,并包括下述步骤:第一步,采集数据;第二步,计算在每个定位时刻二维激光扫描仪在路面的投影点位置坐标;第三步,计算在获得每条物体轮廓线时刻二维激光扫描仪在路面的投影点位置坐标;第四步,获得物体三维重建结果并计算出物体体积。本发明的有益效果在于可对不规则形状物体实施全方位快速扫描,获得物体体积的速度快,精度较高,自动化程度高。而且,本发明算法较简单,设备使用方便。
申请公布号 CN102494611A 申请公布日期 2012.06.13
申请号 CN201110397874.1 申请日期 2011.12.05
申请人 中国人民解放军国防科学技术大学 发明人 冯莹;曹毓;雷兵;魏立安;陈运锦
分类号 G01B11/00(2006.01)I 主分类号 G01B11/00(2006.01)I
代理机构 国防科技大学专利服务中心 43202 代理人 王文惠
主权项 1.一种物体体积快速测量方法,其特征在于,包括下述步骤:将二维激光扫描仪架设于轮式车辆任意一侧,使其扫描平面垂直于地面且垂直于轮式车辆的纵向中轴线方向;单目视觉定位系统与二维激光扫描仪固连在一起,单目视觉定位系统与二维激光扫描仪距离地面的高度相同,两者之间的距离为d;第一步,采集数据;轮式车辆绕行被测量目标一周,绕行期间单目视觉定位系统与二维激光扫描仪同时分别采集数据;设单目视觉定位系统在此绕行期间共完成n次定位,每次定位所对应的时刻为T<sub>i</sub>,i=1,2,L,n,所有时刻T<sub>i</sub>组成单目视觉定位时刻序列T<sub>1</sub>,T<sub>2</sub>,L,T<sub>n</sub>,时刻T<sub>i</sub>定位时获得的轮式车辆航向角为θ<sub>i</sub>,时刻T<sub>i</sub>定位时获得的单目视觉定位系统在路面的投影点位置为P<sub>i</sub>,P<sub>i</sub>在世界坐标系下的坐标为<img file="FDA0000116141790000011.GIF" wi="208" he="58" />单目视觉定位系统在路面所有的投影点位置组成单目视觉定位系统投影点位置序列P<sub>1</sub>,P<sub>2</sub>,L,P<sub>n</sub>;在时刻T<sub>i</sub>扫描仪获取的物体轮廓线序号为k<sub>i</sub>,所有物体轮廓线序号组成物体轮廓线序号序列k<sub>1</sub>,k<sub>2</sub>,L,k<sub>n</sub>,二维激光扫描仪在获得所有物体轮廓线时对应的时刻序列为t<sub>1</sub>,t<sub>2</sub>,...<img file="FDA0000116141790000012.GIF" wi="70" he="53" />所有物体轮廓线L<sub>l</sub>,l=1,2,...k<sub>n</sub>,构成物体轮廓线序列L<sub>1</sub>,L<sub>2</sub>,...<img file="FDA0000116141790000013.GIF" wi="83" he="58" />第二步,计算在每个定位时刻二维激光扫描仪在路面的投影点位置坐标;设在时刻T<sub>i</sub>,二维激光扫描仪在路面的投影点位置为Q<sub>i</sub>,其在世界坐标系下的投影点位置坐标为<img file="FDA0000116141790000014.GIF" wi="202" he="58" />二维激光扫描仪在路面的所有投影点位置组成扫描仪投影点位置序列Q<sub>1</sub>,Q<sub>2</sub>,L,Q<sub>n</sub>;利用下述公式可计算<img file="FDA0000116141790000015.GIF" wi="203" he="58" /><maths num="0001"><![CDATA[<math><mfenced open='{' close=''><mtable><mtr><mtd><msubsup><mi>X</mi><mi>i</mi><mi>S</mi></msubsup><mo>=</mo><msubsup><mi>X</mi><mi>i</mi><mi>C</mi></msubsup><mo>+</mo><mi>d</mi><mo>&times;</mo><msub><mrow><mi>cos</mi><mi>&theta;</mi></mrow><mi>i</mi></msub></mtd></mtr><mtr><mtd><msubsup><mi>Y</mi><mi>i</mi><mi>S</mi></msubsup><mo>=</mo><msubsup><mi>Y</mi><mi>i</mi><mi>C</mi></msubsup><mo>+</mo><mi>d</mi><mo>&times;</mo><msub><mrow><mi>sin</mi><mi>&theta;</mi></mrow><mi>i</mi></msub></mtd></mtr></mtable></mfenced></math>]]></maths>第三步,计算在获得每条物体轮廓线的时刻二维激光扫描仪在路面投影点位置坐标;在相邻的两次定位时刻T<sub>j</sub>和T<sub>j+1</sub>之间,j=1,2,L,n-1,二维激光扫描仪共获得物体轮廓线的数量为k<sub>j+1</sub>-k<sub>j</sub>+1;在扫描仪投影点位置Q<sub>j</sub>和Q<sub>j+1</sub>之间实施线性插值,共线性插值k<sub>j+1</sub>-k<sub>j</sub>-1个点;设在时刻T<sub>j</sub>和T<sub>j+1</sub>之间的所有经线性插值后的点组成二维激光扫描仪在路面的投影点位置序列<img file="FDA0000116141790000021.GIF" wi="311" he="51" />该序列中任意一点q<sub>p</sub>的坐标和该点对应的轮式车辆航向角分别用(x<sub>p</sub>,y<sub>p</sub>)和φ<sub>p</sub>表示,p=k<sub>j</sub>,...,k<sub>j+1</sub>,有:<maths num="0002"><![CDATA[<math><mfenced open='{' close=''><mtable><mtr><mtd><msub><mi>x</mi><mi>p</mi></msub><mo>=</mo><msubsup><mi>X</mi><mi>j</mi><mi>S</mi></msubsup><mo>+</mo><mfrac><mrow><msubsup><mi>X</mi><mrow><mi>j</mi><mo>+</mo><mn>1</mn></mrow><mi>S</mi></msubsup><mo>-</mo><msubsup><mi>X</mi><mi>j</mi><mi>S</mi></msubsup></mrow><mrow><msub><mi>k</mi><mrow><mi>j</mi><mo>+</mo><mn>1</mn></mrow></msub><mo>-</mo><msub><mi>k</mi><mi>j</mi></msub></mrow></mfrac><mrow><mo>(</mo><mi>p</mi><mo>-</mo><msub><mi>k</mi><mi>j</mi></msub><mo>)</mo></mrow></mtd></mtr><mtr><mtd><msub><mi>y</mi><mi>p</mi></msub><mo>=</mo><msubsup><mi>Y</mi><mi>j</mi><mi>S</mi></msubsup><mo>+</mo><mfrac><mrow><msubsup><mi>Y</mi><mrow><mi>j</mi><mo>+</mo><mn>1</mn></mrow><mi>S</mi></msubsup><mo>-</mo><msubsup><mi>Y</mi><mi>j</mi><mi>S</mi></msubsup></mrow><mrow><msub><mi>k</mi><mrow><mi>j</mi><mo>+</mo><mn>1</mn></mrow></msub><mo>-</mo><msub><mi>k</mi><mi>j</mi></msub></mrow></mfrac><mrow><mo>(</mo><mi>p</mi><mo>-</mo><msub><mi>k</mi><mi>j</mi></msub><mo>)</mo></mrow></mtd></mtr></mtable></mfenced></math>]]></maths><maths num="0003"><![CDATA[<math><mrow><msub><mi>&phi;</mi><mi>p</mi></msub><mo>=</mo><mfrac><mrow><msub><mi>&theta;</mi><mrow><mi>j</mi><mo>+</mo><mn>1</mn></mrow></msub><mo>-</mo><msub><mi>&theta;</mi><mi>j</mi></msub></mrow><mrow><msub><mi>k</mi><mrow><mi>j</mi><mo>+</mo><mn>1</mn></mrow></msub><mo>-</mo><msub><mi>k</mi><mi>j</mi></msub></mrow></mfrac><mrow><mo>(</mo><mi>p</mi><mo>-</mo><msub><mi>k</mi><mi>j</mi></msub><mo>)</mo></mrow></mrow></math>]]></maths>在时刻T<sub>1</sub>和T<sub>n</sub>之间的所有经线性插值后的点组成在时刻序列t<sub>1</sub>,t<sub>2</sub>,...<img file="FDA0000116141790000024.GIF" wi="41" he="53" />二维激光扫描仪在路面的投影点位置序列q<sub>1</sub>,q<sub>2</sub>,...<img file="FDA0000116141790000025.GIF" wi="79" he="47" />该序列中任意一点q<sub>l</sub>(l=1,2,...k<sub>n</sub>)的坐标和该点对应的轮式车辆航向角分别用(x<sub>l</sub>,y<sub>k</sub>)和φ<sub>l</sub>表示;第四步,获得物体三维重建结果并计算出物体体积;根据在获得每条物体轮廓线L<sub>l</sub>时刻t<sub>l</sub>下的二维激光扫描仪在路面的投影点坐标(x<sub>l</sub>,y<sub>l</sub>)和该点对应的轮式车辆航向角φ<sub>l</sub>,得到物体轮廓线L<sub>l</sub>在世界坐标系下的投影方程为:Y<sub>l</sub>-y<sub>l</sub>=tan(π/2+φ<sub>l</sub>)×(X<sub>l</sub>-x<sub>l</sub>)根据物体轮廓线L<sub>l</sub>在世界坐标系下的投影方程实施目标物体形貌三维重建;对三维重建结果实施Delaunay三角剖分,获得物体的三角网格模型;由三角网格模型计算出物体体积。
地址 410073 湖南省长沙市开福区德雅路109号