您好,欢迎访问三七文档
当前位置:首页 > 商业/管理/HR > 经营企划 > 基于单位四元数的无初值依赖空间后方交会
以下内容摘自《基于单位四元数的无初值依赖空间后方交会》一文,该论文中有部分错误,以下进行了改正。四元数Tzyxqqqqq],,,[0旋转矩阵R和单位四元数的关系为:321321321222200002222000022220)(2)(2)(2)(2)(2)(2cccbbbaaaqqqqqqqqqqqqqqqqqqqqqqqqqqqqqqqqqqqqRzyxxzyyzxxzyzyxzyxyzxzyxzyx(1)共线条件方程式:ZYfZZcYYbXXaZZcYYbXXafyyyZXfZZcYYbXXaZZcYYbXXafxxxyssssssyxssssssx)()()()()()()()()()()()(33322203331110(2)根据式(1),对式(2)进行线性化,得到的误差方程式为:yzyxxzyxldqcdqcdqcdqcdZscdYscdXscvyldqcdqcdqcdqcdZscdYscdXscvx272625024232221171615014131211(3)其中,Zxxxafacx)(03111Zxxxbfbcx)(03112Zxxxcfccx)(03113XZZqYYqXXqZZZqYYqXXqZfcssxsysyszsx))(2)(2)(2())(2)(2)(2(00214XZZqYYqXXqZZZqYYqXXqZfcsxsszszsysxx))(2)(2)(2())(2)(2)(2(0215XZZqYYqXXqZZZqYYqXXqZfcsyszsssxsyx))(2)(2)(2())(2)(2)(2(00216XZZqYYqXXqZZZqYYqXXqZfcszsysxsxsszx))(2)(2)(2())(2)(2)(2(0217Zyyyafacy)(03221Zyyybfbcy)(03222Zyyycfccy)(03223YZZqYYqXXqZZZqYYqXXqZfcssxsysxsszy))(2)(2)(2())(2)(2)(2(00224YZZqYYqXXqZZZqYYqXXqZfcsxsszssxsyy))(2)(2)(2())(2)(2)(2(00225YZZqYYqXXqZZZqYYqXXqZfcsyszsszsysxy))(2)(2)(2())(2)(2)(2(0226YZZqYYqXXqZZZqYYqXXqZfcszsysxsyszsy))(2)(2)(2())(2)(2)(2(0227ZYfyyylZXfxxxlyyxx00)()()()()()()()()(333222111sssssssssZZcYYbXXaZZZcYYbXXaYZZcYYbXXaX式(3)可写成lxCV(10)其中,TyxvvV2726252423222117161514131211ccccccccccccccCTzyxdqdqdqdqdZsdYsdXsx0Tyxlll由于Tzyxqqqqq],,,[0是单位四元数,因此误差方程式(10)还存在一个约束条件:122220zyxqqqq对上式线性化,可得条件约束方程为000wdqqdqqdqqdqqzzyyxx其中,)1(2122220zyxqqqqw即0wBxx(11)zyxxqqqqB0000联立(10)、(11)式计算7个未知数。
本文标题:基于单位四元数的无初值依赖空间后方交会
链接地址:https://www.777doc.com/doc-2536157 .html