[发明专利]一种多传感器融合定位空间坐标的算法

摘要

本发明公开了一种多传感器融合定位空间坐标的算法，包括底座，底座两端分别通过销轴与固定支架活动连接，固定支架下表面分别通过螺栓与固定脚垫固定连接，底座上表面通过轴承与车体转动连接，机械大臂另一端通过销轴与机械二臂一端活动连接，机械三臂另一端通过销轴与锤头活动连接。本多传感器融合定位空间坐标的算法，采用多种传感器的数据进行融合，成为一组空间坐标，以此标定整个可用空间，比其他空间标定方式更加直接和方便控制，每个传感器值都有特定的控制命令可以进行调节，最终达到不但能够标定整个可用空间的目的，还能够准确控制机械臂到达指定位置，使得测距结果稳定且更接近真值，提高定位精度，响应速度快，失误率低，操作简单。