3.5.12 · D3 · HinglishGuidance, Navigation & Control (GNC)

Worked examplesAttitude estimation — triad method (two vector measurements)

2,971 words14 min read↑ Read in English

3.5.12 · D3 · Physics › Guidance, Navigation & Control (GNC) › Attitude estimation — triad method (two vector measurements)

Yeh page TRIAD parent note ka drill ground hai. Parent ne recipe banai; yahan hum ise har tarah ke input ke against run karte hain jo method ko mil sakta hai — clean rotations, noisy sensors, degenerate (near-parallel) geometry, sign traps, ek real Sun/mag word problem, aur ek exam twist.

Shuru karne se pehle, poore machine ka ek reminder ek saanss mein: hum do reference vectors se ek right-handed triad banate hain (teen mutually perpendicular unit axes — ek chhota coordinate cross), phir wahi triad do body measurements se banate hain, har triad ko ek matrix ( aur ) ke columns mein stack karte hain, aur attitude hai . Perpendicular-axis idea ke liye Cross Product and Right-Handed Frames dekho aur mein kyun hona chahiye iske liye Rotation Matrices and SO(3) dekho.


Scenario matrix

Har TRIAD problem inhi cells mein se kisi ek mein land karta hai. Neeche ke examples ko unke cell label ke saath mark kiya gaya hai.

Cell Kya badlta hai Danger / lesson
A. Clean, aligned true rotation, no noise, axis-aligned vectors zero distraction ke saath mechanics seekho
B. Clean, tilted axis true rotation ek tilted axis ke baare mein non-integer entries; machine ko test karo
C. Noisy slot-2 sensor-2 angle kuch degrees off pura point — angle discard, error chhoti rehti hai
D. Sign / handedness trap slot 1 ↔ slot 2 swap karo, ya left-handed pair do badlta hai; phir bhi hona chahiye
E. Degenerate: near-parallel do vectors ke beech , noise blow up hoti hai — refuse karo
F. Degenerate: exactly parallel ya cross product hai; attitude undetermined
G. Real word problem Sun sensor + magnetometer, given numbers slot 1 = accurate sensor choose karo
H. Exam twist se rotation angle recover karo trace se read out karta hai

Hum A–H order mein karte hain.


Cell A — Clean, aligned (zero noise ke saath mechanics)

Forecast: Compute karne se pehle guess karo — true rotation ke baare mein quarter-turn hai. Tumhare hisaab se ke aur entries kaisi dikhni chahiye? (Hint: standard .)

  1. Reference triad. . , already unit, to . . Yeh step kyun? Slot 1 trusted vector rakhta hai; slot 2 ka cross product automatically usके perpendicular hota hai; slot 3 right-handed box close karta hai.

  2. Body triad, same recipe. ; ; .

    Yeh step kyun? Dono triads same physical cross describe karte hain — ek reference words mein, ek body words mein.

  3. Assemble : Yeh step kyun? column by column; orthonormal .

Verify: ✅ aur ✅; ✅. Yeh exactly hai.

Neeche figure — kya dekhna hai: teen colored arrows reference triad hain. Cyan arrow slot 1 hai (, exactly rakha gaya), amber arrow slot 2 hai (, cyan ke perpendicular), aur white arrow slot 3 hai (, right-handed box close karta hai). Notice karo ki teeno par milte hain — woh orthogonality hi banati hai aur hence ek clean rotation hoti hai.

Figure — Attitude estimation — triad method (two vector measurements)

Cell B — Clean, tilted axis (non-integer entries)

Forecast: Rotation poori tarah -plane mein hai, to untouched rehna chahiye — expect karo ki ki third row/column ho.

  1. Reference triad — Cell A jaisa hi: . Yeh step kyun? Reference vectors unchanged hain, to reference frame identical hai; sirf body side move karti hai.

  2. Body triad. . (already unit) . . Yeh step kyun? Do in-plane vectors ka cross ke along point karta hai — woh axis jiske perpendicular dono sensors lie karte hain.

  3. Assemble :

Verify: ✅ aur ✅; ✅. Upar define ki gayi trace-to-angle identity use karke, , to ✅ — truth se match karta hai. (Quadrant caveat yaad rakhna: trace akela aur mein fark nahi karta; positive off-diagonal pattern counter-clockwise sense confirm karta hai. Hum ise Cell H mein poori tarah push karte hain.)


Cell C — Noisy slot-2 (pura point)

Forecast: TRIAD ko exactly rakhta hai aur sirf cross product ki direction use karta hai. To kya tumhare hisaab se mein error ke aaspaas hogi, ya bahut chhoti? Padhne se pehle guess karo.

  1. Slot 1 exact hai. — noise se untouched. Yeh step kyun? Jo accurate sensor ne produce kiya, use perfectly honor kiya gaya hai.

  2. Slot 2 — cross product, phir normalize. . Iska norm hai, to normalize karne par milta hai exactly (working precision tak). Yeh step kyun? tilt cross product ki length change karta hai ( vs ), lekin normalizing length erase kar deta hai. Sirf direction survive karta hai — aur woh direction barely hili kyunki dono vectors abhi bhi -plane mein hain.

  3. Slot 3 aur assemble. Cell A jaisa identical: , jisse same milta hai.

Verify: Recovered abhi bhi exactly satisfy karta hai aur ✅; ✅. Slot 2 mein noise ne zero attitude error produce kiya kyunki yeh in-plane tilt thi — exactly TRIAD ka design intent: sensor-2 angle discard. (Generally slot-2 noise mein residual first-order nahi, second-order hota hai.) Isliye zyada accurate sensors jaise Sun sensor slot 1 mein jaate hain. Ek method ke liye jo dono measurements optimally weight karta hai, Wahba's Problem aur QUEST algorithm dekho.


Cell D — Sign / handedness trap (order matters)

Forecast: Parent note ne warn kiya tha ki TRIAD asymmetric hai. Guess: same , ya different ?

  1. Reference triad (swapped). ; ; . Yeh step kyun? Cross product ka sign flip ho gaya Cell A ke versus kyunki order flip hua — .

  2. Body triad (swapped). ; ; .

  3. Assemble :

Verify: Yahan data noiseless tha, to swapping se Cell A jaisa same milta hai — achha, dono truth se agree karte hain. Mappings check karo: ✅ aur ✅. Bhi ✅ aur ✅, abhi bhi proper rotation. Lesson: matrix slot ordering ke beech sirf tab differ kar sakta hai jab noise ho (tab do orderings disagree karte hain, aur tumhe trusted sensor slot 1 mein dalna hoga). Left-handed pair dena TRIAD ko break nahi karega — cross product phir bhi automatically right-handed triad build karta hai, guarantee karta hai ki regardless.


Cell E — Degenerate: near-parallel (noise blows up)

Forecast: Cross-product magnitude hai. ke saath yeh chhota hai. Guess: kya ek chhoti input error chhoti rehti hai, ya amplify ho jaati hai?

Pehle, error precisely name karo. (radians mein) ko mein ek tiny out-of-plane angular error hone do — yani, true -plane mein lie karta hai, lekin noisy measurement angle se us plane se bahar tip hui hai (size ka ek small -component). Hum track karte hain ki slot-2 unit vector kitna swing karta hai.

  1. Cross-product magnitude denominator set karta hai. . Yeh step kyun? Slot 2 hai is magnitude se divided. Ek tiny denominator numerator mein jo bhi hai use magnify karta hai.

  2. In-plane wobble harmless kyun hai lekin out-of-plane slip nahi — geometry. Yaad karo do vectors ke spanned plane ke perpendicular hai, length ke saath. Agar sirf -plane ke andar wiggle kare, to spanned plane abhi bhi -plane hai, isliye cross product abhi bhi ke along point karta hai — iska direction unchanged hai, sirf length breathe karti hai (aur normalize karna length erase kar deta hai, jaise Cell C mein). Lekin agar plane se se bahar tip ho, to woh numerator ke perpendicular ko sidewise amount se drag karta hai (ek absolute nudge), jabki jo vector hum divide karte hain woh sirf lamba hai. To unit normal ki fractional swing hai Yeh step kyun? Yahi amplification hai: fixed absolute nudge ko chhoti length se divide karna use multiply karta hai.

  3. Numbers daalo. ke saath, factor hai . Ek modest out-of-plane slip attitude error ban jaata hai.

Verify: Amplification ✅; ✅. Rule: achha separation chahiye (best near , jahan , koi amplification nahi). Agar tumhare do directions close hain, TRIAD galat tool hai — Kalman Filter — Attitude jaisa filtered estimator ya optimal Davenport q-method use karo.

Neeche figure — kya dekhna hai: cyan curve amplification factor hai separation angle ke versus. Dekho yeh par upar rocket karta hai ( par amber marker gain par baitha hai), aur white marker par flatten ho jaata hai — sweet spot jahan errors unmagnified pass hoti hain.

Figure — Attitude estimation — triad method (two vector measurements)

Cell F — Degenerate: exactly parallel (undetermined)

Forecast: Dono vectors ek hi line ke along hain, to kya attitude fully known hai, ya ek degree of freedom lost hai?

  1. Slot 2 compute karo. . Yeh step kyun? Parallel vectors ka cross product zero hota hai ().

  2. Normalize → division by zero. undefined hai. Triad build nahi ho sakta. Yeh step kyun? Geometrically, ek direction sirf 3 mein se 2 degrees of freedom fix karta hai — us line ke baare mein spin invisible hai, isliye sirf in do collinear vectors use karne wala koi bhi method use nahi kar sakta.

Verify: ✅ (anti-parallel utna hi degenerate hai). Rule: TRIAD ko do non-parallel directions chahiye — yahi reason hai ki parent ne "do independent directions" par stress kiya tha.


Cell G — Real word problem (slot 1 wisely choose karo)

Forecast: Kaunsa measurement slot 1 mein jaata hai? Aage padhne se pehle guess karo.

  1. Slots accuracy se assign karo. Slot 1 = Sun sensor (, sabse trusted). To , ; , . Yeh step kyun? Slot 1 exactly honor kiya jaata hai, isliye accurate sensor ki info kabhi degrade nahi hoti.

  2. Reference triad. ; ; .

  3. Body triad. ; ; .

  4. Assemble :

Verify: ✅ (Sun exactly match kiya); ✅; ✅ aur ✅, ek proper rotation. ko onboard propagation ke liye quaternion mein convert karna Quaternion Attitude Kinematics ka kaam hai.


Cell H — Exam twist ( se angle read karo)

Forecast: ki trace (diagonal entries ka sum) rotation angle encode karta hai. Kaun sa angle deta hai — aur kya tum trace se akele bata sakte ho ki yeh clockwise ghuma ya counter-clockwise?

  1. Trace kyun, koi ek entry kyun nahi? Angle se koi bhi proper rotation ke eigenvalues hote hain; unka sum (trace) hai, axis se independent. Ek single matrix entry axis aur angle mix karti hai, isliye woh isolate nahi kar sakti; trace kar sakta hai. (Yeh identity upar ke definition callout mein stated hai.) Yeh step kyun? Hum se woh ek scalar choose karte hain jo sirf par depend karta hai.

  2. se invert karo. Cell B se, . Tab Yeh step kyun? yeh sawaal hai "kaunsa angle is cosine ka hai?" — yeh cosine ko undo karta hai.

  3. Quadrant ambiguity ka saamna karo. Kyunki aur sirf output karta hai, trace deta hai lekin nahi bata sakta ki turn (counter-clockwise) tha ya (clockwise) — dono ka trace hai. Tie break karne ke liye tum off-diagonal part padhte ho: skew piece axis ko uske sign ke saath carry karta hai. Yahan , jo sense ko ke baare mein counter-clockwise pin karta hai. Yeh step kyun? even hai, isliye sign lose ho jaata hai; antisymmetric part use restore karta hai.

Verify: aur ✅. Recovered magnitude , jo truth se match karta hai jo humne hide ki thi; positive skew entry sense confirm karti hai ✅.


Active Recall

Recall Kaunsi cell TRIAD ko break karti hai, aur kyun?

Cells E aur F — near-parallel aur exactly-parallel inputs. F mein cross product hai (division by zero); E mein se divide karna noise ko se multiply karta hai. Fix: achha angular separation demand karo, ideally ke paas.

Recall Cell C mein slot-2 sensor

off tha. Kitna attitude error aaya, aur kyun? Essentially zero yahan — kyunki cross product ko normalize karna uski length throw away kar deta hai ( angle ki), sirf direction rakhta hai, jo in-plane tilt ke liye barely hili. TRIAD slot-2 angle discard karne ke liye designed hai.

Recall

kya batata hai, aur kya hide karta hai? Yeh rotation angle ka magnitude deta hai se ::: lekin iska sign nahi — clockwise vs counter-clockwise ke liye off-diagonal (skew) part chahiye, kyunki even hai.

Recall

Sun sensor aur magnetometer ke liye slot assignment? Sun sensor slot 1 mein (exactly honored), magnetometer slot 2 mein (sirf uski direction use hoti hai) ::: kyunki slot 1 ka measurement perfectly preserve hota hai jabki slot 2 ka precise angle discard ho jaata hai.