Skip to content

Commit fa5a167

Browse files
committed
fix readme
1 parent beb0b70 commit fa5a167

1 file changed

Lines changed: 1 addition & 1 deletion

File tree

guidance/reference_filter_dp_quat/README.md

Lines changed: 1 addition & 1 deletion
Original file line numberDiff line numberDiff line change
@@ -50,7 +50,7 @@ Each time step performs three operations:
5050

5151
1. **Compute reference error** — The 6D reference $r$ is the error between the waypoint goal and the nominal pose:
5252
- $r_{0:3} = p_{goal} - p_{nominal}$
53-
- $r_{3:6} = \text{quaternion\_error}(q_{nominal},\ q_{goal})$
53+
- $r_{3:6} = q_{\mathrm{err}}(q_{nominal}, q_{goal})$
5454

5555
The `quaternion_error` function returns $2 \cdot \text{vec}(q_{nominal}^{-1} \otimes q_{goal})$, which for small angles approximates the rotation vector from nominal to goal.
5656

0 commit comments

Comments
 (0)