自主移动机构法矢检测与调姿运动方法

摘要

一种自主移动机构法矢检测与调姿运动方法，其特征是它包括以下步骤：首先，在自主移动机构末端执行器上安装有三个或四个激光测距传感器；其次，利用三个或四个激光测距传感器所测的值求得所测制孔平面法矢n；第三，根据上述测量计算所的制孔平面法矢n通过调姿运动反解算法，得到自主移动机构到达制孔法矢的各腿驱动量，用于控制系统实现调姿运动；最后，根据上述测量计算所的制孔平面法矢n通过调姿运动反解算法，得到自主移动机构到达制孔法矢时，刀具的偏移量，用于控制系统实现刀具偏移纠正。本发明方法简单，易于控制，控制精度高，高效快速。