主权项 |
1.一种快速的离散三维点云滤波方法,其特征是点云滤波方法为:1)、使用一个固定深度摄像头获取三维目标的离散点云。2)、对点云数据创建三维体素栅格,体素栅格内所有点最终就用一个重心点<img file="FSA00000956539500000111.GIF" wi="160" he="79" />表示,即<maths num="0001"><![CDATA[<math><mrow><mover><mi>x</mi><mo>‾</mo></mover><mo>=</mo><mn>1</mn><mo>/</mo><mi>s</mi><munder><mi>Σ</mi><mrow><mrow><mo>(</mo><mi>x</mi><mo>,</mo><mi>y</mi><mo>,</mo><mi>z</mi><mo>)</mo></mrow><mo>∈</mo><mi>A</mi></mrow></munder><mi>x</mi></mrow></math>]]></maths><maths num="0002"><![CDATA[<math><mrow><mover><mi>y</mi><mo>‾</mo></mover><mo>=</mo><mn>1</mn><mo>/</mo><mi>s</mi><munder><mi>Σ</mi><mrow><mrow><mo>(</mo><mi>x</mi><mo>,</mo><mi>y</mi><mo>,</mo><mi>z</mi><mo>)</mo></mrow><mo>∈</mo><mi>A</mi></mrow></munder><mi>y</mi></mrow></math>]]></maths><maths num="0003"><![CDATA[<math><mrow><mover><mi>z</mi><mo>‾</mo></mover><mo>=</mo><mn>1</mn><mo>/</mo><mi>s</mi><munder><mi>Σ</mi><mrow><mrow><mo>(</mo><mi>x</mi><mo>,</mo><mi>y</mi><mo>,</mo><mi>z</mi><mo>)</mo></mrow><mo>∈</mo><mi>A</mi></mrow></munder><mi>z</mi><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>1</mn><mo>)</mo></mrow></mrow></math>]]></maths>其中,S为体素栅格A内离散点的总数,(x,y,z)是体素栅格内的任意一点。3)、计算离散点云全局距离的均值和方差<maths num="0004"><![CDATA[<math><mrow><mover><mi>d</mi><mo>‾</mo></mover><mo>=</mo><mn>1</mn><mo>/</mo><mi>n</mi><munderover><mi>Σ</mi><mrow><mi>l</mi><mo>=</mo><mn>1</mn></mrow><mi>n</mi></munderover><msub><mi>dis</mi><mi>l</mi></msub><mo>,</mo><mi>D</mi><mrow><mo>(</mo><mi>dis</mi><mo>)</mo></mrow><mo>=</mo><munderover><mi>Σ</mi><mrow><mi>l</mi><mo>=</mo><mn>1</mn></mrow><mi>n</mi></munderover><msup><mrow><mo>(</mo><msub><mi>dis</mi><mi>l</mi></msub><mo>-</mo><mover><mi>d</mi><mo>-</mo></mover><mo>)</mo></mrow><mn>2</mn></msup><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>2</mn><mo>)</mo></mrow></mrow></math>]]></maths>其中,n为点云的数目,dis是两个点之间的距离,<img file="FSA0000095653950000015.GIF" wi="36" he="54" />是离散点云全局距离的均值,D(dis)是离散点云全局距离的方差。4)、计算离散点云全局的距离阈值<maths num="0005"><![CDATA[<math><mrow><msub><mi>d</mi><mi>θ</mi></msub><mo>=</mo><mover><mi>d</mi><mo>‾</mo></mover><mo>+</mo><mi>λ</mi><mo>*</mo><msqrt><mi>D</mi><mrow><mo>(</mo><mi>dis</mi><mo>)</mo></mrow></msqrt><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>3</mn><mo>)</mo></mrow></mrow></math>]]></maths>其中,λ为标准方差系数,d<sub>θ</sub>是离散点云全局的距离阈值。5)、计算某一个点和其领域点之间的平均距离<img file="FSA0000095653950000017.GIF" wi="68" he="66" />并判断其与全局距离阈值之间的关系。<maths num="0006"><![CDATA[<math><mrow><mi>Π</mi><mo>=</mo><mfenced open='{' close=''><mtable><mtr><mtd><mover><msub><mi>d</mi><mi>l</mi></msub><mo>‾</mo></mover><mo>></mo><msub><mi>d</mi><mi>θ</mi></msub><mo>,</mo><mi>outliers</mi></mtd></mtr><mtr><mtd><mover><msub><mi>d</mi><mi>l</mi></msub><mo>‾</mo></mover><mo>≥</mo><msub><mi>d</mi><mi>θ</mi></msub><mo>,</mo><mi>inliers</mi></mtd></mtr></mtable></mfenced><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>4</mn><mo>)</mo></mrow></mrow></math>]]></maths>当<img file="FSA0000095653950000019.GIF" wi="162" he="66" />则判断该点为离群点(outliers);当<img file="FSA00000956539500000110.GIF" wi="163" he="66" />则判断该点为内点(inliers)。 |