测距功能

当前测距需要依赖激光雷达等额外的传感器，其他原理的方案距离反馈精度还不够好，意见已经收到。