1.一种相机相对位姿求解方法,其特征在于,
获取图像的深度信息,包括通过相机采集被测物体的图像;
获取所述相机的加速度和角速度以及姿态角;
估算所述相机在高度方向的运动,获取所述相机在高度方向上的高度值;
估算所述相机在当前的所述高度值上的姿态,获取所述相机在二维平面上的二维位姿;
将所述姿态角、所述高度值和所述二维位姿进行融合计算,获得所述相机的三维位姿;
在获取所述相机的加速度和角速度以及姿态角的步骤中,通过惯性测量单元对所述相机进行测量;
在获取所述相机在高度方向上的高度值的步骤中,采用垂直运动估计模块对所述相机进行测量;
在所述垂直运动估计模块测量过程中,
抽取由所述相机采集得到的深度图像中的最后一行像素,再根据惯性测量单元测得的当前相机倾角,测量当前所述相机的高度方向上的所述高度值;
在获取所述相机在二维平面上的二维位姿过程中,采用水平运动估计模块对所述二维位姿进行测量;
在所述水平运动估计模块的测量过程中,抽取由所述相机采集得到的深度图像中的多行像素,并将该多行像素的像素值转换为点云,用以估计在当前所述高度值对应二维平面上的所述二维位姿。
2.如权利要求1所述的相机相对位姿求解方法,其特征在于,在所述相机采集被测物体的图像步骤中,所述相机为RGB‑D相机或双目相机。
3.如权利要求1所述的相机相对位姿求解方法,其特征在于,在将所述姿态角、所述高度值和所述二维位姿进行融合计算的步骤中,采用扩展卡尔曼滤波器进行处理数据。
4.如权利要求3所述的相机相对位姿求解方法,其特征在于,在采用扩展卡尔曼滤波器进行处理数据的步骤中,具体为将所述二维位姿和所述高度值输入扩展卡尔曼滤波器进行处理获得测量值,再与所述加速度、所述角速度以及所述姿态角融合计算,获得所述三维位姿。