一种机械式振捣机的振捣位置计算方法及系统

本发明公开了一种机械式振捣机的振捣位置计算方法及系统，通过回转传感器、倾角传感器、拉绳传感器和激光传感器等多源传感数据，结合三角函数坐标解析算法以及旋转坐标系转换，精确测量振捣位置的三维坐标，同时可计算振捣深度以及振捣棒任一点坐标。本发明能够实时、高精度地计算振捣位置的三维坐标。