function qnb = qdelphi(qpb, phi) qnb = qmul(rv2q(phi), qpb);
时间: 2024-04-10 07:27:48 浏览: 51
QPB9319 datasheet
这是一个计算姿态变化后的四元数的。它接受一个姿态四元数 `pb` 和一个姿态变化角度 `phi` 作为输入,并返回更新后的姿态四元数 `qnb`。
函数的实现如下:
```matlab
function qnb = qdelphi(qpb, phi)
qnb = qmul(rv2q(phi), qpb);
```
其中,`rv2q` 函数用于将旋转向量转换为四元数,`qmul 函数用于计算两个四元数的乘积。这个函数首先将姿态变化角度 `phi` 转换为对应的四元数,然后将其与姿态四元数 `qpb` 相乘得到更新后的姿态四元数 `qnb`。
阅读全文