Commit 45d4a54
authored
fix: correct external detection rotation in opennav_docking (#899)
* replace tf2::Quaternion::setEuler() with tf2::Quaternion::setRPY()
- setEuler(p, r, y) rotation order: Rz(y) -> Rx(r) -> Ry(p)
- setRPY(r, p, y) rotation order: Rx(r) -> Ry(p) -> Rz(y)
* the computed rotation remains the same in the following cases:
- when yaw rotation equals 0.0, or
- when roll and pitch rotations both equal 1.0
* non-default rotation that differs from the above cases will break
Implements documentation for ros-navigation/navigation2#6047
Signed-off-by: Nikolaos Drosinos <nikolaos.drosinos@ocado.com>1 parent b49536a commit 45d4a54
1 file changed
Lines changed: 10 additions & 0 deletions
| Original file line number | Diff line number | Diff line change | |
|---|---|---|---|
| |||
202 | 202 | | |
203 | 203 | | |
204 | 204 | | |
| 205 | + | |
| 206 | + | |
| 207 | + | |
| 208 | + | |
| 209 | + | |
| 210 | + | |
| 211 | + | |
| 212 | + | |
| 213 | + | |
| 214 | + | |
205 | 215 | | |
206 | 216 | | |
207 | 217 | | |
| |||
0 commit comments