硬件配置:STM32H7+SDRAM+MT9V034+200mW 808NM线型激光+窄带滤波片
软件逻辑:三角测距配合位姿(MPU9250),获得三维空间的绝对坐标
效果图,左侧是matlab中显示3D点云,右侧是实际环境。
下图是V1版本,结构上不稳定,用了几天就改了。
标定过程比较简陋,卷尺+EXCEL,但效果还是蛮明显的,6m距离精度在±3%
V2是现用的结构,3D打印了个架子,尺寸和强度都蛮不错。
三角测距原理图
核心代码:灰度重心找激光的x轴位置,转换成X Y Z三轴坐标,这几句抠了两个星期
V3版本结构,还在调
|