Multiply two rotations: q * r
(q, r B2Rot)
| 625 | |
| 626 | /// Multiply two rotations: q * r |
| 627 | func B2RotMul(q, r B2Rot) B2Rot { |
| 628 | return B2Rot{ |
| 629 | S: q.S*r.C + q.C*r.S, |
| 630 | C: q.C*r.C - q.S*r.S, |
| 631 | } |
| 632 | } |
| 633 | |
| 634 | /// Transpose multiply two rotations: qT * r |
| 635 | func B2RotMulT(q, r B2Rot) B2Rot { |