加权最小范数法在单冗余度机器人容错算法中的应用

利用梯度投影法对冗余度机器人进行容错轨迹规划时，常常导致关节速度变化较大，为解决这一问题，将加权最小范数法引入到容错轨迹规划中．理论分析及ＢＵＡＡ－ＲＲ七自由度机器人的仿真研究结果表明，利用加权最小范数法可以获得更平滑的关节速度，这说明它是一种有效的容错轨迹规划算法．

基于四元数估计角速率的陀螺故障定位

当卫星速率积分陀螺的配置冗余度不满足一致性检验条件时 ,不能单纯利用硬件冗余实现陀螺的故障定位。鉴于角度和角速度敏感器的输出通过卫星运动学相关 ,本文利用姿态测量敏感器的输出来诊断陀螺故障。首先根据姿态测量敏感器的输出得到卫星姿态四元数 ,进而根据四元数动力学方程得到粗略的姿态角速度信息 ,并将此角速度作为输出信息用于对卫星动力学方程的滤波 ,从而得到较精确的角速度信息 ,为单冗余度陀螺组件的故障定位提供解析冗余信息。利用四元数方法可以避免出现奇点。仿真结果证明了该方法的有效性。