功能:在SE3下求右雅克比矩阵的逆矩阵

格式:SLAM_SE3_invJr(T)、SLAM_SE3_invJr(v)

T : 为4*4的SE3矩阵变量
v : 为6*1或者1*6的矩阵变量，存储SE3中李代数向量

说明:
1、函数不检查T当中旋转矩阵性质
2、v当中后3个变量对应旋转部分
3、函数执行成功返回6*6的矩阵变量
4、本函数返回结果和{SLAM_SE3_Jr<矩阵运算\SLAM_SE3_Jr>}结果互为逆矩阵

例子:
v = 1:6;
j = SLAM_SE3_invJr(v);//执行完毕返回v对应的右雅克比矩阵的逆