Skip to content

Commit

Permalink
use n
Browse files Browse the repository at this point in the history
  • Loading branch information
baggepinnen committed Jun 25, 2024
2 parents 9aebfc1 + add1bf9 commit 051a975
Showing 1 changed file with 2 additions and 2 deletions.
4 changes: 2 additions & 2 deletions src/orientation.jl
Original file line number Diff line number Diff line change
Expand Up @@ -420,10 +420,10 @@ function nonunit_quaternion_equations(R, w)
# They also have w_a = angularVelocity2(frame_a.R) even for quaternions, so w_a = angularVelocity2(Q, der(Q)), this is their link between w_a and D(Q), while ours is D(Q̂) .~ (Ω * Q̂)
Ω = [0 -w[1] -w[2] -w[3]; w[1] 0 w[3] -w[2]; w[2] -w[3] 0 w[1]; w[3] w[2] -w[1] 0]
# QR = from_Q(Q, angular_velocity2(Q, D.(Q)))
QR = from_Q(Q̂ ./ sqrt('), w)
QR = from_Q(Q̂ ./ sqrt(n), w)
[
n ~'
c ~ k * (1 - ')
c ~ k * (1 - n)
D.(Q̂) .~ Q̂d
Q̂d .~' * Q̂) ./ 2 + c *# We use Ω' which is the same as using -w to handle the fact that w coming in here is typically described frame_a rather than in frame_b, the paper is formulated with w being expressed in the rotating body frame (frame_b)
Q .~./ sqrt(n)
Expand Down

0 comments on commit 051a975

Please sign in to comment.