[发明专利]一种基于双轴倾角传感器的空间旋转角度测量方法

说明书

技术领域

本发明属于几何长度测量技术领域，涉及一种空间旋转角度测量方法，尤其是一种基于双轴倾角传感器的空间旋转角度测量方法。

背景技术

现有技术中，关于角度测量，有多种方法，如机械指针式测角仪、激光测量旋转角度、电子罗盘、倾角传感器和陀螺仪。

机械指针式角度测量仪，只能适合空间旋转轴平行于水平面的情况。因为机械式角度测量仪，其指针的摆动是依靠重力和指针轴的微小摩擦力，如果旋转轴倾斜，则指针轴摩擦力增大，导致指针摆动不准确。电子罗盘是以微弱的地磁方向为基准，检测当前方向和地磁方向的夹角，获得当前的方位角。显然，电子罗盘不能检测以地磁方向为旋转轴的旋转角度。而一般情况下，地磁方向几乎就是水平方向，所以，电子罗盘不能检测一个方向的倾角。陀螺仪是速率传感器，能检测当前旋转速率，通过速率积分，可获得当前的旋转角度，而且是全方位的角度检测。但是陀螺仪的主要问题就是其游走误差，即使在角度不变的情况下，陀螺仍有输出信号，这显然无法精确测量角度。

倾角传感器能够检测任何一个非垂直于水平面和水平面之间的静态夹角，而且测量结果稳定、可靠。特别是现在采用MEMS工艺制造的微型倾角传感器，其测量准确度更高。但是，现有的倾角传感器及其模块有两个缺点：1）只能测量静态角度，即只能测量当前平面和水平面之间的夹角，不能测量旋转轴和水平面有夹角情况下的空间旋转角；2）要求传感器和及其外壳必须水平面安装，否则测量不准确。

发明内容

本发明的目的在于克服上述现有技术的缺点，提供一种基于双轴倾角传感器的空间旋转角度测量方法，其通过传感器和旋转轴之间空间位置关系，建立数学模型，并获得解析解，从而计算出围绕旋转轴旋转的角度。所以，该方法能够测量空间旋转角度，且该旋转轴不一定平行于水平面，

本发明的目的是通过以下技术方案来解决的：

这种基于双轴倾角传感器的空间旋转角度测量方法，包括以下步骤：

1）使双轴倾角传感器的两个轴相互垂直，其输出电压是以水平面为参考的角度的正弦值；以旋转轴为Y轴，设逆时针旋转方向为正，旋转角度为θ，其在水平面的投影为y轴，两个轴交点为o，设旋转轴和水平面的夹角β，即β＝∠Yoy，β∈[0,π/2]；z轴垂直于水平面，设定x轴方向，构成右手笛卡尔坐标系xyzo；令X轴和x轴重合，Z轴垂直X、Y轴，同样构成笛卡尔坐标系XYZo；设双轴倾角传感器的两个轴为u和v，其交点定在o点，因为ou和ov是相互垂直的，设过o点的uov平面的法向量为ow，且，ou、ov和ow都为单位长度向量，ou的单位长度设为oP=|ou|，oP在yoz平面上的投影为oQ，定义oQ和旋转轴Y之间的夹角为γ，γ∈[-π/2,π/2]，设oP和x/X轴之间的夹角为α，α∈[0,2π]；

2）以uvwo坐标系的ow轴在yoz平面上为转动参考零位，即ow、oZ、oz、oQ、oY和oy都在一个平面上，那么，∠Zoz＝β和∠woZ=γ；如果ow轴不在yoz平面上，就通过旋转oY轴，将ow轴旋转到yoz平面，并以此为零位；

3）设ow、ou、ov和oY的单位向量分别为和其在xyzo坐标系的向量表达为：