四元数空间后方交会开源包

请问有哪些利用四元数的开源包做空间后方交会。sba的sba_mot_levmar_x
输出结果一直为-1，不知道发生了什么问题。数据都是按照右手坐标系做的。