قطب‌نمای الکترونیکی سه‌محوره، جبران شیب، مدل‌سازی اعوجاج آهن سخت و نرم و الگوریتم‌های کالیبراسیون بیضوی

14.3. اندازه‌گیری چندمحوره و جهت

قطب‌نماهای الکترونیکی مدرن (Electronic Compasses / e-Compass) برخلاف عقربه‌های مکانیکی سنتی که آزادانه روی یک محور افقی معلق بودند، سنسورهای حالت جامد سه‌محوره‌ای هستند که به بدنه وسیله نقلیه یا مدار چاپی فیکس شده‌اند. هنگامی که یک سامانه (نظیر پهپاد، موشک، ربات یا تلفن همراه) در فضا دچار چرخش، غلتش یا شیب طولی می‌شود، قرائت سنسورهای مغناطیسی به شدت تحت تأثیر زاویه قرارگیری قرار می‌گیرد. در این زیرفصل، قراردادهای مختصات ناوبری، مبانی ریاضی محاسبه سمت مغناطیسی، تمایز بنیادین میان شمال مغناطیسی و جغرافیایی، و فرمول‌بندی تحلیلی جبران شیب سه‌بعدی تشریح می‌شود.

14.3.1. جهت محورها و قرارداد مختصات

یک ماژول مغناطیس‌سنج سه‌محوره از سه المان حسگر عمود بر هم تشکیل شده است که خروجی آن‌ها بردار القای مغناطیسی را در دستگاه مختصات متصل به بدنه (Body Frame که با نماد b نشان داده می‌شود) اندازه‌گیری می‌کند:

B→b=[BxbBybBzb]

چارچوب‌های استاندارد مختصات

در سامانه‌های ناوبری اینرسی و رباتیک، دو دستگاه مختصات اصلی به کار می‌روند:

  1. دستگاه ناوبری مماس بر زمین (Navigation Frame / Local Tangent Frame, n):
    استاندارد متداول در هوانوردی و خودرو، چارچوب راست‌گرد NED (North-East-Down) است:

    • محور Xn: مماس بر سطح زمین، مثبت رو به شمال ژئودتیک.
    • محور Yn: مماس بر سطح زمین، مثبت رو به شرق.
    • محور Zn: عمود بر سطح زمین، مثبت رو به مرکز زمین (پایین).
      (در برخی سامانه‌های رباتیک از چارچوب ENU یعنی East-North-Up نیز استفاده می‌شود).
  2. دستگاه متصل به بدنه (Body Frame, b):
    محورهای مختصات فیزیکی متصل به بدنه متحرک بر اساس استاندارد ISO 1151-1 / DIN 9300 به صورت زیر تعریف می‌شوند:

    • محور Xb (محور طولی – Longitudinal Axis): در امتداد بدنه، مثبت رو به جلو (دماغه وسیله نقلیه).
    • محور Yb (محور عرضی – Lateral Axis): مثبت رو به سمت راست (بال راست).
    • محور Zb (محور عمودی – Vertical Axis): عمود بر دو محور قبل، مثبت رو به کف وسیله (پایین).
                 +Xb (جلو / دماغه)
                     ^
                     |
                     |
                     +----> +Yb (سمت راست / بال راست)
                    /
                   /
                  v  +Zb (رو به پایین / کف)

دوران‌های زاویه‌ای بدنه نسبت به چارچوب ناوبری افقی با سه زاویه اویلر استاندارد توصیف می‌شوند:

  • زاویه غلتش (Roll, ϕ): دوران حول محور Xb (بال راست پایین: ϕ>0).
  • زاویه فراز یا پیچ (Pitch, θ): دوران حول محور Yb (دماغه بالا: θ>0).
  • زاویه سَمت یا یاو (Yaw / Heading, ψ): دوران حول محور Zb (دماغه به سمت راست / ساعت‌گرد: ψ>0).

14.3.2. جهت مغناطیسی و تفاوت با شمال جغرافیایی

محاسبه سمت مغناطیسی در حالت ایده‌آل افقی

اگر سنسور مغناطیس‌سنج کاملاً در راستای افق تراز باشد (ϕ=0 و θ=0)، تنها دو محور Xb و Yb بر روی صفحه افقی زمین قرار می‌گیرند. در این حالت، زاویه سَمت مغناطیسی وسیله نسبت به شمال مغناطیسی از رابطه زیر محاسبه می‌شود:

ψm=atan2(−Byb,Bxb)

چرایی حضور علامت منفی پشت Byb:
بردار میدان مغناطیسی زمین در فضا یک بردار ثابت است که مؤلفه افقی آن رو به شمال مغناطیسی قرار دارد. اگر وسیله نقلیه در جهت ساعت‌گرد به سمت راست بچرخد (زاویه سمت ψm مثبت و افزایش‌یابنده)، جهت شمال مغناطیسی نسبت به بدنه وسیله به سمت چپ متمایل می‌شود؛ در نتیجه مؤلفه عرضی خوانده‌شده توسط سنسور منفی می‌گردد (Byb<0). بنابراین برای آنکه زاویه سَمت ناوبری با قرارداد هوانوردی (زاویه مثبت در جهت ساعت‌گرد از 0∘ تا 360∘) تطابق کامل داشته باشد، اعمال علامت منفی الزامی است:

  شمال مغناطیسی (B_h)
         ^
         |   / +Xb (دماغه متمایل به راست: ψ > 0)
         |  /
         | / ) زاویه سمت ψ
         +-----------------> +Yb
          \
           \  جهت B_h در مختصات بدنه دارای By منفی است

با استفاده از تابع ریاضی دو آرگومانی atan2(y,x)، زاویه خروجی در دامنه پیوسته [−π,+π] یا [−180∘,+180∘] به دست می‌آید که در صورت منفی بودن، با افزودن 360∘ به بازه استاندارد [0∘,360∘) تبدیل می‌شود:

if ψm<0⟹ψm=ψm+360∘

تمایز شمال مغناطیسی و شمال حقیقی (انحراف مغناطیسی)

یکی از اشتباهات رایج در مهندسی ناوبری، فرض هم‌پوشانی شمال مغناطیسی با قطب شمال جغرافیایی است. در عمل سه تعریف متمایز برای «شمال» وجود دارد:

  1. شمال مغناطیسی (Magnetic North – MN): راستایی که مؤلفه افقی بردار میدان ژئومغناطیسی زمین به سوی آن اشاره می‌کند. این نقطه در طول دهه‌های اخیر با سرعتی حدود 40 تا 50 کیلومتر در سال در حال جابه‌جایی در نواحی قطب شمال است.
  2. شمال حقیقی یا جغرافیایی (True North / Geographic North – TN): راستای قطب شمال جغرافیایی زمین که محور دوران وضعی کره خاکی است و تمامی نصف‌النهارها در آنجا همگرا می‌شوند. نقشه‌ها و مختصات GPS همگی بر مبنای شمال حقیقی هستند.
  3. شمال شبکه (Grid North – GN): امتداد خطوط شبکه موازی در سیستم‌های تصویر نقشه مانند UTM.

زاویه افقی میان امتداد شمال حقیقی و شمال مغناطیسی، زاویه میل مغناطیسی یا انحراف مغناطیسی (Magnetic Declination, D) نامیده می‌شود:

ψtrue=ψm+D

قرارداد علامت انحراف مغناطیسی (D):

  • میل شرقی (Easterly Declination, D>0): زمانی که شمال مغناطیسی در سمت شرق شمال حقیقی قرار داشته باشد (مقدار D باید به زاویه قطب‌نما اضافه شود).
  • میل غربی (Westerly Declination, D<0): زمانی که شمال مغناطیسی در سمت غرب شمال حقیقی باشد (مقدار D باید از زاویه قطب‌نما کسر گردد).

مقدار زاویه میل مغناطیسی بسته به موقعیت جغرافیایی و زمان متغیر است و از طریق مدل‌های ریاضی استاندارد جهانی (مانند WMM یا IGRF) استخراج می‌شود. برای مثال در شهر تهران، در سال 2026 میل مغناطیسی حدود +4.5∘ (شرقی) است؛ یعنی یک قطب‌نمای بدون خطا جهت شمال را 4.5∘ به سمت راست نشان می‌دهد که باید با کسر این مقدار، سمت حقیقی استخراج شود.


14.3.3. اثر شیب و نیاز به جبران آن

در کاربردهای واقعی، وسیله متحرک به ندرت کاملاً تراز و افقی حرکت می‌کند. برای نمونه، یک پهپاد برای حرکت رو به جلو باید کج شود (زاویه پیچ رو به پایین θ<0) و برای دور زدن باید کج شود (زاویه رول ϕ).

چرا شیب باعث خطای فاجعه‌بار در قطب‌نما می‌شود؟

همان‌طور که در بخش 14.1 بیان شد، بردار میدان مغناطیسی زمین در بیشتر نقاط کره زمین شیب‌دار است و زاویه میل قائم (I) دارد. در نیمکره شمالی، مؤلفه قائم میدان زمین (Bz) بسیار قوی‌تر از مؤلفه افقی است (در تهران Bz≈40 μT در برابر Bh≈28 μT).

اگر سنسور شیب پیدا کند، مؤلفه بزرگ Bz روی محورهای افقی سنسور (Xb و Yb) نشت (Projection) می‌کند. اگر مهندس ناوبری بدون جبران شیب از رابطه ساده atan2(−By,Bx) استفاده کند، خطایی تا چند ده درجه در جهت‌یابی به وجود می‌آید که حتی می‌تواند وسیله را در جهت کاملاً معکوس هدایت کند!

          میدان قائم Bz (رو به پایین، بسیار قوی)
                       |
                       |      سنسور کج‌شده با زاویه شیب θ
                       v      +Xb /
                       |         /
                       |   θ    /
                       | \     /
                       |   \  /
                       +-----v------- صفحه افقی
                             |
                   نشت مؤلفه قائم بر روی محور Xb:
                   ΔBx = Bz * sin(θ)

الگوریتم و ریاضیات جبران شیب (Tilt Compensation)

برای حذف خطای شیب، باید بردار میدان اندازه‌گیری‌شده در چارچوب بدنه (B→b) به صفحه کاملاً افقی مماس بر زمین تصویر شود. این فرآیند با ترکیب داده‌های شتاب‌سنج سه‌محوره (برای اندازه‌گیری بردار گرانش زمین) و مغناطیس‌سنج انجام می‌پذیرد.

گام 1: تخمین زوایای غلتش (ϕ) و فراز (θ) توسط شتاب‌سنج
در شرایط شبه‌استاتیک (شتاب خطی ناچیز)، شتاب‌سنج تنها بردار شتاب ثقل زمین (g→) را در چارچوب بدنه اندازه‌گیری می‌کند (A→b=[Ax,Ay,Az]T). با استفاده از روابط مثلثاتی استاندارد هوانوردی:

ϕ=atan2(Ay,Az)
θ=atan2(−Ax,Ay2+Az2)

گام 2: ماتریس تبدیل دوران و تصویر به صفحه افق
برای خنثی‌سازی شیب‌های ϕ و θ، باید بردار بدنه در معکوس ماتریس‌های دوران غلتش و فراز ضرب شود تا مؤلفه‌های تراز افقی (Xh,Yh) به دست آیند (مطابق Application Note استاندارد ST AN3192):

Xh=Bxbcosθ+Bybsinϕsinθ+Bzbcosϕsinθ
Yh=Bybcosϕ−Bzbsinϕ

گام 3: استخراج زاویه سمت جبران‌شده
اکنون که مؤلفه‌های Xh و Yh دقیقاً در صفحه افقی ناوبری قرار گرفته‌اند، زاویه سمت مغناطیسی تصحیح‌شده بدون کوچکترین وابستگی به شیب به دست می‌آید:

ψm=atan2(−Yh,Xh)

تکینگی ژیروسکوپی (Gimbal Lock):
در شیب قائم θ=±90∘ (حالت عمودی پرواز دماغه به سمت بالا یا پایین)، محور طولی بدنه (Xb) دقیقاً با محور قائم ناوبری (Zn) هم‌راستا می‌شود. در این وضعیت، تفکیک زوایای غلتش (Roll) و سمت (Yaw) از نظر ریاضی غیرممکن شده و ماتریس زوایای اولر دچار تکینگی (Gimbal Lock) می‌گردد که در سامانه‌های پیشرفته فضایی با جبران برداری کواترنیونی مدیریت می‌شود.


مثال مهندسی حل‌شده: تحلیل عددی خطای شیب و محاسبه سمت جبران‌شده پهپاد

یک کوادکوپتر در حال پرواز در ناحیه‌ای با مشخصات ژئومغناطیسی زیر قرار دارد:

  • مؤلفه افقی میدان مغناطیسی زمین: Bh=28.00 μT
  • مؤلفه قائم میدان زمین (رو به پایین): Bz=40.00 μT
  • سمت واقعی پهپاد: دقیقاً رو به شمال مغناطیسی (ψreal=0.00∘).

پهپاد در اثر وزش باد جانبی دچار زاویه غلتش (Roll) معادل ϕ=+10.00∘ (کج شدن بال راست رو به پایین) شده است، در حالی که زاویه فراز (Pitch) آن صفر است (θ=0.00∘).

در اثر این شیب عرضی، مؤلفه قائم میدان زمین (Bz) مستقیماً روی محور عرضی سنسور (Yb) نشت می‌کند و سنسور روی بدنه پهپاد مقادیر زیر را قرائت می‌کند:

  • مؤلفه طولی: Bxb=Bh=+28.00 μT
  • مؤلفه عرضی: Byb=Bzsinϕ=40.00×sin(10.00∘)=40.00×0.17365=+6.95 μT
  • مؤلفه عمودی بدنه: Bzb=Bzcosϕ=40.00×cos(10.00∘)=40.00×0.98481=+39.39 μT

مطلوب است:

  1. محاسبه زاویه سمت خام (ψraw) بدون جبران شیب و تعیین مقدار خطای جهت‌گیری.
  2. محاسبه مؤلفه‌های تصویرشده در صفحه افق (Xh و Yh) با استفاده از روابط تحلیلی جبران شیب.
  3. محاسبه زاویه سمت جبران‌شده نهایی (ψcompensated) و اثبات حذف کامل خطای شیب.

حل گام‌به‌گام:

گام 1: محاسبه زاویه سمت خام بدون جبران شیب
اگر سیستم ناوبری شیب سنجش‌شده را نادیده بگیرد و مستقیماً از داده‌های خام بدنه برای جهت‌یابی استفاده کند:

ψraw=atan2(−Byb,Bxb)=atan2(−6.95,28.00)

محاسبه زاویه:

ψraw=arctan(−6.9528.00)=arctan(−0.2482)≈−13.94∘≡346.06∘

خطای جهت‌گیری حاصل از نادیده گرفتن شیب:

Error=|ψraw−ψreal|=|−13.94∘−0.00∘|=13.94∘

این نتیجه نشان می‌دهد که تنها 10∘ شیب عرضی (غلتش)، خطایی نزدیک به 14∘ در قطب‌نما ایجاد کرده است که می‌تواند سامانه خودمختار را از کریدور پروازی خارج کند.

گام 2: تصویر بردار به صفحه افق با روابط تحلیلی جبران شیب
مقادیر توابع مثلثاتی به ازای θ=0.00∘ و ϕ=+10.00∘:

  • sinθ=0.0000,cosθ=1.0000
  • sinϕ=0.17365,cosϕ=0.98481

محاسبه مؤلفه افقی طولی Xh:

Xh=Bxbcosθ+Bybsinϕsinθ+Bzbcosϕsinθ
Xh=(28.00×1.0000)+(6.95×0.17365×0.0000)+(39.39×0.98481×0.0000)=28.00 μT

محاسبه مؤلفه افقی عرضی Yh:

Yh=Bybcosϕ−Bzbsinϕ
Yh=(6.946×0.98481)−(39.392×0.17365)=6.8405−6.8404≈0.000 μT

مشاهده می‌شود که عبارت دوم (تصویر اثر قائم Bzbsinϕ) دقیقاً اثر نشت میدان عمودی در مؤلفه اول (Bybcosϕ) را از نظر جبری تفریق و خنثی کرده و مقدار Yh را دقیقاً به صفر کاهش داده است.

گام 3: استخراج زاویه سمت جبران‌شده
اکنون زاویه سمت نهایی از مؤلفه‌های تصحیح‌شده افقی به دست می‌آید:

ψcompensated=atan2(−Yh,Xh)=atan2(−0.000,28.00)=0.00∘

محاسبات فوق به طور دقیق و تحلیلی اثبات می‌کند که با اجرای الگوریتم جبران شیب، خطای 13.94∘ به طور کامل و بدون کوچکترین دست‌کاری حذف شده و زاویه سمت به مقدار واقعی 0.00∘ همگرا می‌شود.


14.4. تداخل و اعوجاج مغناطیسی

عملکرد دقیق هر قطب‌نمای الکترونیکی بر این فرض استوار است که سنسور منحصراً میدان ژئومغناطیسی طبیعی زمین را اندازه‌گیری می‌کند. با این حال، در محیط‌های عملیاتی واقعی، سنسور بر روی بردهای الکترونیکی متراکم، در مجاورت باتری‌ها، موتورها، کابل‌های انتقال جریان بالا و درون سازه‌های فلزی نصب می‌شود. مواد و اجزای پیرامونی سنسور، میدان مغناطیسی محیط را به شدت دچار اعوجاج، خمش و انحراف می‌کنند. در فیزیک حسگری و ناوبری، این اعوجاجات مغناطیسی به دو رده بنیادین تقسیم می‌شوند: «اعوجاج آهن سخت» (Hard Iron Distortion) و «اعوجاج آهن نرم» (Soft Iron Distortion). در این زیرفصل، پایه‌های فیزیکی، مدل‌های ریاضی ماتریسی و رفتار تداخل‌گرهای دینامیکی بررسی می‌شوند.

14.4.1. اثر آهن سخت

اعوجاج آهن سخت حاصل حضور مواد یا قطعات فرومغناطیسی دارای مغناطش پسماند دائم (Permanent Magnetization / High Coercivity) است که روی سازه یا برد متصل به سنسور قرار دارند.

منشأ فیزیکی و ویژگی‌های آهن سخت

منابع آهن سخت شامل موارد زیر هستند:

  • آهنرباهای دائم موجود در بلندگوها، بازرها، قفل‌های مغناطیسی درب‌ها و استاتور موتورهای DC.
  • اجزای فولادی یا فلزی ساختار که در حین فرآیند ساخت، ماشین‌کاری، لحیم‌کاری یا در اثر قرارگیری در معرض شوک‌های مغناطیسی دچار مغناطش دائمی شده‌اند (نظیر پیچ‌های فولادی، پوشش‌های محافظ باتری، فریم‌های شاسی و پین‌های کانکتور).

از آنجا که این منابع مستقیماً به کالبد وسیله نقلیه یا برد مدار چاپی فیکس شده‌اند، موقعیت و جهت آن‌ها نسبت به سنسور در طول زمان و با چرخش وسیله کاملاً ثابت است. بنابراین با دوران سامانه در فضا، بردار میدان مغناطیسی تولیدشده توسط این قطعات همگام با سنسور می‌چرخد و همواره یک مقدار برداری ثابت را به خروجی اضافه می‌کند.

مدل ریاضی و اثر هندسی آهن سخت

اثر آهن سخت در مدل ریاضی به صورت یک بردار آفست جمع‌شونده ثابت (Additive Bias Vector, V→hi) فرمول‌بندی می‌شود:

B→meas=B→true+V→hi=[Bx,trueBy,trueBz,true]+[VhxVhyVhz]
  • در فضای سه‌بعدی: اگر یک سنسور ایده‌آل را در تمام جهات فضایی بچرخانیم، نوک بردار B→true کره‌ای به مرکز مبدأ مختصات (0,0,0) و شعاعی برابر با بزرگی میدان زمین (Bearth) جاروب می‌کند:
    Bx2+By2+Bz2=Bearth2

    حضور بردار آهن سخت V→hi این کره را بدون کوچکترین تغییر در شکل یا اندازه، صرفاً در فضا انتقال (Translation) می‌دهد، به گونه‌ای که مرکز کره از مبدأ به نقطه (Vhx,Vhy,Vhz) منتقل می‌شود.

  • در صفحه دوبعدی (چرخش افقی): دایره داده‌های افقی سنسور از مبدأ جابه‌جا شده و مرکز آن آفست پیدا می‌کند:
    (Bx,meas−Vhx)2+(By,meas−Vhy)2=Bh2

اثر آهن سخت بر خطای سمت قطب‌نما

حضور آفست آهن سخت، یک خطای دوره‌ای تک‌سینوسی (Single-Cycle Error) با دوره تناوب 360∘ در زاویه سمت قطب‌نما تولید می‌کند که رابطه تقریبی آن به صورت زیر است:

Δψhi≈VhyBhcosψ−VhxBhsinψ

اگر مقدار آفست آهن سخت حتی کسری کوچک از میدان زمین باشد (مثلاً 10 μT در میدان 30 μT)، خطای سمت قطب‌نما می‌تواند به بیش از 20∘ تا 30∘ برسد.


14.4.2. اثر آهن نرم

اعوجاج آهن نرم ناشی از برهم‌کنش مواد فرومغناطیس نرم با تراوایی مغناطیسی بالا و پسماند ناچیز (مانند آلیاژهای آهن خالص، فولادهای کم‌کربن، نیکل، فریت‌ها، شیلدهای الکترومغناطیسی و ترکیبات باتری) با میدان مغناطیسی زمین است.

منشأ فیزیکی و تفاوت بنیادین با آهن سخت

مواد آهن نرم بر خلاف آهن سخت، خودبه‌خود میدان مغناطیسی دائمی ندارند. با این حال، به دلیل ضریب تراوایی مغناطیسی نسبی بسیار بالا (μr≫1)، این مواد مسیری با رلوکتانس بسیار پایین برای خطوط میدان فراهم می‌کنند. در نتیجه، خطوط میدان مغناطیسی خارجی (میدان زمین) خمیده شده و به درون این مواد کشیده و متمرکز می‌شوند (Flux Distortion and Bending).

ویژگی کلیدی آهن نرم این است که شدت و جهت میدان القایی آن مستقیماً تابعی از شدت و جهت میدان مغناطیسی خارجی اعمال‌شده است. وقتی سنسور در میدان زمین می‌چرخد، مغناطش القایی مواد آهن نرم به طور مداوم تغییر می‌کند.

       خطوط موازی میدان زمین (ایده‌آل)
       ----------------------------->
       ----------------------------->
       ----------------------------->

       اعوجاج خطوط میدان در مجاورت ماده آهن نرم:
       -------------\     /--------->
       --------------\===/---------->  [قطعه آهن نرم]
       -------------/     \--------->

مدل ریاضی و اثر هندسی آهن نرم

از دیدگاه ریاضی، رابطه میان میدان القایی آهن نرم و میدان واقعی یک تبدیل خطی تانسوری است که به صورت ضرب یک ماتریس مربعی 3×3 (𝐖si) در بردار میدان زمین مدل می‌شود:

B→meas=𝐖si·B→true=[wxxwxywxzwyxwyywyzwzxwzywzz][Bx,trueBy,trueBz,true]

یادداشت تحلیلی پیرامون تقارن ماتریس: بر اساس اصول فیزیک الکترومغناطیس و روابط متقابل اونزاگر (Onsager Reciprocal Relations)، تانسور پذیرفتاری مغناطیسی مواد فرومغناطیس خطی متقارن است (wxy=wyx). با این وجود، در سنسورهای تجاری MEMS، ماتریس کالیبراسیون تجربی علاوه بر پدیده آهن نرم، خطاهای مکانیکی عدم تعامد محورهای حسگر (Non-orthogonality) و عدم تطابق بهره کانال‌های الکترونیکی را نیز در بر می‌گیرد؛ از این رو ماتریس کلی تبدیل در عمل می‌تواند مؤلفه‌های نامتقارن جزئی نیز داشته باشد.

در این ماتریس:

  1. درایه‌های روی قطر اصلی (wxx,wyy,wzz): فاکتورهای مقیاس (Scale Factors) در امتداد محورهای سنسور هستند. به دلیل عدم تقارن فیزیکی هندسه قطعات فلزی اطراف سنسور، تراوایی مغناطیسی در راستاهای مختلف یکسان نیست (wxx≠wyy≠wzz). این عدم تقارن باعث می‌شود که کره یا دایره ایده‌آل کشیده یا فشرده شده و به یک بیضی (Ellipse) در صفحه یا بیضوی (Ellipsoid) در فضا تبدیل گردد.
  2. درایه‌های خارج از قطر اصلی (wxy,wxz,wyz): ضرایب جفت‌شدگی محورهای متقاطع (Cross-Axis Coupling / Shear) هستند. این جملات نشان‌دهنده آن هستند که اعمال میدان در یک محور (مثلاً محور X) باعث القای مؤلفه میدان بر روی محور دیگر (مثلاً محور Y) می‌شود. اثر هندسی این درایه‌ها، دوران محورهای اصلی بیضی (Tilt Angle) نسبت به محورهای فیزیکی سنسور است.

اثر آهن نرم بر خطای سمت قطب‌نما

اعوجاج آهن نرم یک خطای دوره‌ای دوسینوسی (Two-Cycle Error) با دوره تناوب 180∘ در زاویه سمت ایجاد می‌کند:

Δψsi≈C1sin(2ψ)+C2cos(2ψ)

(توجه شود که در تئوری کلاسیک انحراف قطب‌نما موسوم به فرمول آرچیبالد اسمیت، ضرایب فوریه خطای دوره‌ای با نمادهای تفکیک‌شده نمایش داده می‌شوند و با نماد زاویه میل مغناطیسی زمین یعنی D کاملاً متفاوت هستند).

دیاگرام اسکی زیر ترکیب اثر آهن سخت (جابه‌جایی مرکز) و آهن نرم (تبدیل دایره به بیضی چرخیده) را در مقایسه با حالت ایده‌آل نشان می‌دهد:

              +By
               ^
               |       *** بیضی اعوجاج‌یافته ***
               |    *         * (آهن نرم + آهن سخت)
         +-----+--*------+      *
        /      | *   +   *       *
       |   +   |*  مرکز   *       *
       | (0,0) | * بیضی   *      *
        \      |  *      *      *
         +-----+---*----+      *
               |     *        *
               |       ******
  -------------+------------------------> +Bx
               |

14.4.3. موتور، کابل قدرت، آهنربا و سازهٔ فلزی

در کاربردهای مهندسی مکاترونیک، پهپاد و اتومبیل‌های هوشمند، تداخلات مغناطیسی تنها محدود به خطاهای استاتیک نیستند، بلکه منابع تداخل دینامیکی متغیر با زمان نیز چالش‌های بزرگی ایجاد می‌کنند.

1. موتورهای الکتریکی (DC، براشلس BLDC و استپر)

موتورهای الکتریکی دو منبع تداخل هم‌زمان تولید می‌کنند:

  • تداخل استاتیک: آهنرباهای نئودیمیوم دائمی قوی درون روتور که میدانی استاتیک با دامنه بالا تولید می‌کنند و مانند یک منبع آهن سخت قوی عمل می‌کنند.
  • تداخل دینامیکی متغیر با بار و دور موتور: عبور جریان‌های متناوب سه‌فاز از سیم‌پیچ‌های استاتور میدان‌های مغناطیسی چرخانی متناسب با گشتاور و بار مکانیکی موتور تولید می‌کند که دامنه و فرکانس آن با تغییر تراتل (دسته گاز) تغییر می‌کند.

2. کابل‌های قدرت جریان بالا و باتری

کابل‌های رابط میان باتری لیتیوم-پلیمر (LiPo) و سیستم‌های کنترل سرعت الکترونیکی (ESC) یا اینورترهای توان، جریان‌های مستقیمی از 10 تا بیش از 100 آمپر را هدایت می‌کنند:

  • بر اساس قانون بیو-ساوار (B=μ0I2πr)، جریان 50 آمپر در فاصله 10 سانتی‌متری از سنسور، میدان تداخلی معادل 100 μT ایجاد می‌کند که 2 تا 3 برابر کل میدان زمین است!
  • علاوه بر جریان DC متغیر با بار، سوئیچینگ فرکانس بالای ترانزیستورهای ماسفت اینورتر (بین 8 تا 32 کیلوهرتز) پالس‌های جریان پالسی PWM شدیدی با هارمونیک‌های فرکانس بالا تزریق می‌کند.

3. سازه‌ها و صفحات فلزی

بدنه فولادی خودروها، آرماتورهای فولادی در بتن مسلح پل‌ها و ساختمان‌ها، و ریل‌های قطار به عنوان تله‌های مغناطیسی عمل می‌کنند و باعث همگرایی و واگرایی شدید خطوط میدان زمین می‌شوند. اگر رباتی از روی یک صفحه فلزی عبور کند، اعوجاج آهن نرم به صورت ناگهانی نقطه کار سنسور را تغییر می‌دهد.

مدل کلی کامل اندازه‌گیری سنسور

با در نظر گرفتن تمامی منابع اعوجاج استاتیک و نویز تصادفی سنسور، مدل ریاضی کلی سیگنال خروجی مغناطیس‌سنج به صورت رابطه تانسوری زیر بیان می‌شود:

B→meas=𝐖si·B→true+V→hi+n→

که در آن:

  • B→meas: بردار 3×1 داده خام اندازه‌گیری‌شده توسط سنسور.
  • 𝐖si: ماتریس 3×3 اعوجاج آهن نرم و خطای مقیاس.
  • B→true: بردار 3×1 واقعی میدان ژئومغناطیسی زمین در چارچوب سنسور.
  • V→hi: بردار 3×1 آفست آهن سخت.
  • n→: بردار 3×1 نویز تصادفی حرارتی و سنسوری (نویز گاوسی سفید).

مثال مهندسی حل‌شده: تحلیل تحلیلی اعوجاج آهن سخت و نرم و خطای زاویه‌ای قطب‌نما

یک مغناطیس‌سنج دو‌محوره در صفحه افقی یک خودروی خودران نصب شده است. مشخصات میدان افقی زمین در منطقه برابر با Bh=30.00 μT است.

در اثر نصب نامناسب در مجاورت یک بلندگو و سازه فلزی شاسی، پارامترهای اعوجاج به صورت تجربی زیر شناسایی شده‌اند:

  1. بردار آفست آهن سخت:
    V→hi=[VhxVhy]=[+6.00 μT−4.50 μT]
  2. ماتریس اعوجاج آهن نرم:
    𝐖si=[1.100.000.000.90]

    (محور X به اندازه 10% تقویت شده و محور Y به اندازه 10% تضعیف شده است).

مطلوب است:

  1. محاسبه مقادیر خام اندازه‌گیری‌شده توسط سنسور (Bx,meas و By,meas) هنگامی که خودرو دقیقاً به سمت شمال مغناطیسی حرکت می‌کند (ψreal=0.00∘).
  2. محاسبه زاویه سمت خام قرائت‌شده توسط قطب‌نما (ψraw) و مقدار خطای جهت‌گیری (Δψ) در این زاویه.
  3. اگر خودرو به سمت شمال شرقی (ψreal=45.00∘) بچرخد، مقادیر جدید اندازه‌گیری‌شده و زاویه سمت خام را محاسبه کنید.
  4. تحلیل مقایسه‌ای خطای زاویه‌ای در این دو جهت و اثبات سهم اعوجاجات.

حل گام‌به‌گام:

گام 1: محاسبه مقادیر اندازه‌گیری در جهت شمال (ψreal=0.00∘)
در جهت شمال، بردار واقعی میدان زمین در صفحه افقی سنسور برابر است با:

Bx,true=Bhcos(0∘)=30.00 μT
By,true=−Bhsin(0∘)=0.00 μT

با اعمال مدل ریاضی کامل (B→meas=𝐖siB→true+V→hi):

Bx,meas=(1.10×30.00)+6.00=33.00+6.00=+39.00 μT
By,meas=(0.90×0.00)+(−4.50)=0.00−4.50=−4.50 μT

گام 2: محاسبه سمت خام و خطای جهت‌گیری در جهت شمال
زاویه سمت قرائت‌شده توسط الگوریتم خام:

ψraw=atan2(−By,meas,Bx,meas)=atan2(−(−4.50),39.00)=atan2(+4.50,39.00)
ψraw=arctan(4.5039.00)=arctan(0.11538)≈6.58∘

خطای جهت‌گیری در جهت شمال:

Error1=ψraw−ψreal=6.58∘−0.00∘=+6.58∘

گام 3: محاسبه مقادیر اندازه‌گیری در جهت شمال شرقی (ψreal=45.00∘)
در زاویه 45.00∘:

Bx,true=Bhcos(45∘)=30.00×0.70711=+21.213 μT
By,true=−Bhsin(45∘)=−30.00×0.70711=−21.213 μT

اعمال ماتریس آهن نرم و بردار آهن سخت:

Bx,meas=(1.10×21.213)+6.00=23.334+6.00=+29.334 μT≈+29.33 μT
By,meas=(0.90×(−21.213))+(−4.50)=−19.092−4.50=−23.592 μT≈−23.59 μT

محاسبه زاویه سمت خام در این جهت:

ψraw=atan2(−By,meas,Bx,meas)=atan2(−(−23.592),29.334)=atan2(+23.592,29.334)
ψraw=arctan(23.59229.334)=arctan(0.80425)≈38.81∘

خطای جهت‌گیری در جهت شمال شرقی:

Error2=ψraw−ψreal=38.81∘−45.00∘=−6.19∘

گام 4: تحلیل مقایسه‌ای و نتیجه‌گیری مهندسی

  • در جهت شمال، خطا برابر با +6.58∘ است که خودرو را به سمت راست منحرف می‌کند.
  • در جهت شمال شرقی، خطا به −6.19∘ تغییر علامت داده و خودرو را به سمت چپ منحرف می‌کند.
  • اختلاف کلی میان دو جهت به بیش از 12.77∘ می‌رسد که نشان‌دهنده ماهیت غیرخطی و سینوسی خطاهای مغناطیسی ناشی از ترکیب آهن سخت (آفست مرکز) و آهن نرم (تغییر نسبت مقیاس محورها) است. این تحلیل لزوم حیاتی اجرای الگوریتم‌های کالیبراسیون و اصلاح بیضوی را که در زیرفصل 14.5 تدوین می‌شوند، اثبات می‌کند.

14.5. جانمایی و کالیبراسیون

یک مغناطیس‌سنج دقیق بدون جانمایی فیزیکی اصولی و اجرای الگوریتم‌های کالیبراسیون ریاضی، عملاً به عنوان یک قطب‌نمای قابل اعتماد کارایی نخواهد داشت. اعوجاجات آهن سخت و نرم ناشی از سازه و قطعات پیرامونی، داده‌های ایده‌آل کروی میدان زمین را به یک بیضوی نامتقارن، جابه‌جا شده و چرخیده در فضا تبدیل می‌کنند. در این زیرفصل، الزامات جانمایی سنسور روی مدار چاپی و بدنه، روش‌های برداشت داده میدانی، الگوریتم‌های ریاضی برازش کمترین مربعات بیضوی، و نحوه ارزیابی خطای باقیمانده تشریح می‌شوند.

14.5.1. انتخاب محل روی برد و بدنه

نخستین و مهم‌ترین گام در طراحی یک قطب‌نمای الکترونیکی، ایزولاسیون مکانی سنسور از منابع تداخل مغناطیسی است؛ زیرا طبق قانون بیو-ساوار و تئوری دوقطبی‌های مغناطیسی، شدت میدان با افزایش فاصله به شدت افت می‌کند:

  • میدان سیم‌های حامل جریان متناسب با معکوس فاصله افت می‌کند (B∝1r).
  • میدان آهنرباها و قطعات فرومغناطیس متناسب با توان سوم فاصله افت می‌کند (B∝1r3).

اصول جانمایی روی برد مدار چاپی (PCB Layout Rules)

  1. حریم حفاظتی (Keep-Out Zone): در اطراف تراشه مغناطیس‌سنج باید یک ناحیه خالی با شعاع حداقل 15 تا 25 میلی‌متر تعریف شود که در آن هیچ قطعه فرومغناطیسی یا خط جریان بالا قرار نگیرد.
  2. پرهیز از قطعات حاوی آهن و نیکل: کانکتورهای USB با پوشش فولادی، پایه‌های باتری، بازرها، بلندگوها، پین‌هدرهای با آبکاری نیکل و سلف‌های بدون شیلد باید تا حد امکان دورتر از سنسور مونتاژ شوند. استفاده از قطعات با پایه‌های مس-فسفر یا برنج غیرمغناطیسی در اولویت است.
  3. مسیریابی خطوط جریان بالا: هیچ‌گاه نباید ترک‌های تغذیه قدرت یا خطوط باتری از لایه‌های زیرین تراشه سنسور عبور داده شوند.
  4. تکنیک خنثی‌سازی میدان با مسیرهای رفت و برگشت زوج (Differential / Star Routing): با هدایت مسیر رفت و برگشت جریان در مجاورت یکدیگر در لایه‌های بالا و پایین برد، میدان‌های مغناطیسی تولیدشده توسط جریان‌های قرینه یکدیگر را طبق قانون آمپر خنثی می‌کنند (∮B→·dl→≈0).

جانمایی در پهپادها و روبات‌ها (دکل قطب‌نما)

در پرنده‌های بدون سرنشین (پهپادها و مولتی‌روتورها)، جریان عبوری از کابل‌های باتری به موتورها در حین پرواز گاهی به بیش از 100 آمپر می‌رسد و جریان‌های PWM شدید ایجاد می‌کند. برای نجات قطب‌نما از این جهنم مغناطیسی، استاندارد طلایی صنعت ناوبری هوایی، نصب ماژول مغناطیس‌سنج به همراه GPS بر روی یک دکل ایزوله‌کننده (Compass Mast / Stand-off) در ارتفاع 10 تا 20 سانتی‌متری بالاتر از بدنه اصلی و دور از اسپیدکنترلرها (ESC) است.

       [ماژول قطب‌نما + GPS]
                ||
                ||  دکل فیبر کربن یا آلومینیومی (15cm)
                ||  (ایزولاسیون از جریان‌های بالا)
         =======||=======  بدنه پهپاد (شاسی)
         |              |
     [باتری LiPo]   [ESC & موتورها]

14.5.2. برداشت داده در جهت‌های مختلف

برای کالیبره کردن سنسور و استخراج ضرایب ماتریس آهن نرم و بردار آهن سخت، سنسور باید داده‌هایی را در زوایای فضایی مختلف از میدان زمین ثبت کند.

روش‌های چرخش و جمع‌آوری نمونه‌ها

  1. روش کالیبراسیون مسطح دو بعدی (2D Rotation):
    • چرخش کامل 360∘ وسیله حول محور قائم در یک صفحه افقی تراز.
    • مناسب برای خودروها و قایق‌ها که حرکات غلتش و فراز شدید ندارند.
    • محدودیت: فقط آفست محورهای X و Y را تصحیح می‌کند و اثر مؤلفه Z را نادیده می‌گیرد.
  2. روش چرخش فضایی سه‌بعدی کامل (3D Figure-8 Calibration):
    • چرخاندن وسیله نقلیه به شکل عدد 8 انگلیسی (Figure-8) در فضا در تمامی جهات ممکن، شامل دوران‌های کامل حول محورهای Roll، Pitch و Yaw.
    • پوشش نقاط بالایی، پایینی، جانبی و مایل کره داده‌ها.

شروط یک برداشت داده معتبر

  • توزیع یکنواخت فضایی (Spatial Uniformity): داده‌ها باید به صورت یکنواخت تمام سطح کره را پوشش دهند. اگر کاربر در یک جهت خاص مکث طولانی داشته باشد، تمرکز نمونه‌ها در یک نقطه باعث ایجاد وزن نامطلوب در الگوریتم برازش کمترین مربعات شده و نتایج کالیبراسیون را به سمت آن زاویه دچار سوگیری (Bias) می‌کند.
  • حذف داده‌های پرت (Outlier Filtering): هرگونه نمونه دارای نویز ضربه‌ای ناشی از امواج رادیویی یا لرزش‌های شدید مکانیکی باید پیش از اجرای الگوریتم برازش حذف شوند.

14.5.3. اصلاح آفست و اعوجاج و ارزیابی باقی‌ماندهٔ خطا

1. روش کالیبراسیون مقدماتی حداقل-حداکثر (Min-Max Method)

ساده‌ترین روش برای تصحیح، یافتن بیشینه و کمینه داده‌های خام روی هر محور در طول چرخش است:

Vhx=Bx,max+Bx,min2,Vhy=By,max+By,min2,Vhz=Bz,max+Bz,min2

فاکتورهای مقیاس آهن نرم محورها نیز بر اساس نیم‌طول قطرها تعدیل می‌شوند:

Sx=Bx,max−Bx,min2,Sy=By,max−By,min2,Sz=Bz,max−Bz,min2
S¯=Sx+Sy+Sz3⟹Bx,cal=(S¯Sx)(Bx,meas−Vhx)

محدودیت عمده: روش Min-Max تنها قادر به تغییر مقیاس محورهای اصلی است و درایه‌های خارج از قطر ماتریس آهن نرم (دوران و اعوجاج برشی بیضی) را جبران نمی‌کند؛ همچنین در برابر نویزهای نقطه‌ای آسیب‌پذیر است.

2. الگوریتم برازش کمترین مربعات بیضوی (Least Squares Ellipsoid Fitting)

روش استاندارد و جامع کالیبراسیون سه‌بعدی، برازش یک بیضوی عمومی بر روی ابرنقاط اندازه‌گیری‌شده در فضا است. معادله کلی یک رویه درجه دوم در فضای سه‌بعدی دکارتی به صورت زیر بیان می‌شود:

ax2+by2+cz2+2dxy+2exz+2fyz+2gx+2hy+2iz+j=0

فرم ماتریسی جمع‌وجور این معادله:

(B→meas−V→offset)T𝐀(B→meas−V→offset)=Bearth2

که در آن:

  • V→offset=V→hi بردار آفست آهن سخت (مختصات مرکز بیضوی در فضا) است.
  • 𝐀=𝐖si−T𝐖si−1 یک ماتریس 3×3 متقارن مثبت معین است که شکل و جهت بیضوی را معین می‌کند.

با تجزیه مقادیر ویژه (Eigenvalue Decomposition) ماتریس 𝐀:

𝐀=𝐕Λ𝐕T

ماتریس تصحیح نهایی آهن نرم (𝐌cal=𝐖si−1) به صورت زیر استخراج می‌شود:

𝐌cal=𝐕Λ𝐕T

معادله کالیبراسیون جامع برای تبدیل هر بردار خام به بردار کالیبره‌شده کروی:

B→calibrated=𝐌cal·(B→meas−V→offset)
(الف) داده‌های خام اندازه‌گیری (بیضوی آفست‌دار):
           +By
            ^
            |     *****
            |   *       *
            |  *    +    *  مرکز جابه‌جا شده (V_offset)
            |   *       *   شعاع‌های نامساوی
  ----------+-------+-------------> +Bx
            |

(ب) داده‌های کالیبره‌شده (کره کامل و نرمال):
           +By
            ^
            |     *****
            |   *       *
            |  *    +    *  مرکز در مبدأ (0,0)
            |   *       *   شعاع یکنواخت = B_earth
  ----------+-------+-------------> +Bx
            |

3. ارزیابی باقی‌مانده خطا (Residual Error Analysis)

برای اعتبارسنجی کیفیت کالیبراسیون، از شاخص آماری خطای شعاعی باقیمانده (Radial Residual Error) استفاده می‌شود:

ϵk=‖B→calibrated,k‖−Bearth=Bx,cal,k2+By,cal,k2+Bz,cal,k2−Bearth

ریشه میانگین مربعات خطا (RMS Residual Error) برای N نقطه آزمایشی:

RMSresidual=1N∑k=1Nϵk2
  • در یک کالیبراسیون عالی، مقدار RMSresidual باید کمتر از 0.3 μT تا 0.5 μT (حدود 1% بزرگی میدان زمین) باشد.
  • چنین دقتی، خطای نهایی زاویه سمت قطب‌نما را در کل دامنه 360∘ به کمتر از 0.5∘ تا 1.0∘ کاهش می‌دهد.

مثال مهندسی حل‌شده: اجرای ماتریسی الگوریتم کالیبراسیون و ارزیابی خطای باقیمانده

یک مغناطیس‌سنج دومحوره پس از برداشت داده‌های چرخش در یک پهپاد، مشخصات اعوجاج بیضوی زیر را به دست داده است:

  • مختصات مرکز بیضی اعوجاج‌یافته (آفست آهن سخت):
    V→offset=[VhxVhy]=[+8.00 μT−5.00 μT]
  • ماتریس تصحیح نرمال‌سازی آهن نرم (معکوس ماتریس اعوجاج مقیاس):
    𝐌cal=[0.909090.000000.000001.11111]

    (محور X اولیه دارای بهره 1.10 بوده که با ضرب در 1/1.10=0.90909 اصلاح می‌شود، و محور Y دارای بهره 0.90 بوده که با ضرب در 1/0.90=1.11111 اصلاح می‌شود).

شدت میدان افقی استاندارد زمین در محل آزمون برابر با Bh=30.00 μT است.

در یک لحظه پروازی مشخص، سنسور داده‌های خام زیر را اندازه می‌گیرد:

Bx,meas=+41.00 μT,By,meas=−5.00 μT

مطلوب است:

  1. محاسبه زاویه سمت خام قرائت‌شده توسط سنسور بدون کالیبراسیون (ψraw).
  2. اعمال رابطه کالیبراسیون ماتریسی و محاسبه بردار کالیبره‌شده (B→calibrated).
  3. محاسبه زاویه سمت نهایی کالیبره‌شده (ψcalibrated).
  4. محاسبه بزرگی بردار حاصله، خطای باقیمانده شعاعی (ϵ) و درصد خطای مقیاس نسبت به میدان زمین.

حل گام‌به‌گام:

گام 1: محاسبه زاویه سمت خام قبل از کالیبراسیون

ψraw=atan2(−By,meas,Bx,meas)=atan2(−(−5.00),41.00)=atan2(+5.00,41.00)
ψraw=arctan(5.0041.00)=arctan(0.12195)≈6.95∘

سامانه بدون کالیبراسیون جهت را 6.95∘ (متمایل به راست) نشان می‌دهد، در حالی که جهت واقعی رو به شمال (0.00∘) است.

گام 2: اعمال ماتریس کالیبراسیون و حذف آفست آهن سخت و نرم
رابطه کالیبراسیون:

B→calibrated=𝐌cal·(B→meas−V→offset)

محاسبه تفاضل آفست آهن سخت:

ΔBx=Bx,meas−Vhx=41.00−(+8.00)=+33.00 μT
ΔBy=By,meas−Vhy=−5.00−(−5.00)=0.00 μT

ضرب در ماتریس تصحیح آهن نرم 𝐌cal:

Bx,cal=0.90909×33.00=+30.000 μT
By,cal=1.11111×0.00=0.000 μT

گام 3: استخراج زاویه سمت کالیبره‌شده

ψcalibrated=atan2(−By,cal,Bx,cal)=atan2(−0.000,30.000)=0.00∘

مشاهده می‌شود که زاویه سمت کالیبره‌شده دقیقاً برابر با 0.00∘ (شمال مطلق) شده و خطای 6.95∘ قطب‌نما به طور کامل صفر شده است.

گام 4: ارزیابی بزرگی میدان و خطای باقیمانده شعاعی
بزرگی بردار کالیبره‌شده:

‖B→calibrated‖=Bx,cal2+By,cal2=(30.00)2+(0.00)2=30.00 μT

خطای شعاعی باقیمانده:

ϵ=‖B→calibrated‖−Bh=30.00 μT−30.00 μT=0.00 μT

درصد خطای باقیمانده:

Residual Percentage=0.0030.00×100%=0.00%

این نتیجه نشان می‌دهد که با اجرای کالیبراسیون ماتریسی، داده‌های اندازه‌گیری به طور کامل روی دایره ایده‌آل میدان زمین نگاشت شده و خطاهای ناشی از آهن سخت و نرم به طور هم‌زمان خنثی شده‌اند.


پرسش‌ها و پاسخ‌های تحلیلی و آموزشی

پرسش 1: تفاوت هندسی اثر آهن سخت و آهن نرم بر روی داده‌های کروی سه‌بعدی چیست؟
پاسخ: اثر آهن سخت ناشی از مغناطش دائمی اجزای متصل به بدنه است که یک آفست برداری ثابت ایجاد می‌کند؛ بنابراین کره ایده‌آل داده‌های میدان زمین بدون تغییر در شکل یا اندازه، صرفاً در فضا جابه‌جا (انتقال) می‌یابد. در مقابل، اثر آهن نرم ناشی از تغییر مسیر خطوط میدان در مواد فرومغناطیس با نفوذپذیری بالا است؛ از این رو کره ایده‌آل را فشرده یا کشیده کرده و محورهای آن را می‌چرخاند و آن را به یک بیضوی (Ellipsoid) سه بعدی تبدیل می‌کند.

پرسش 2: چرا کالیبراسیون دو بعدی مسطح برای قطب‌نمای پهپادها و هواگردها ناکافی است؟
پاسخ: کالیبراسیون دو بعدی تنها با چرخش حول یک محور افقی انجام می‌شود و بنابراین صرفاً قادر به استخراج آفست و مقیاس محورهای X و Y در همان صفحه است. در هواگردها و پهپادها که مانورهای غلتش (Roll) و فراز (Pitch) شدید دارند، مؤلفه قائم میدان زمین (Bz) روی محورهای افقی نشت می‌کند. بدون کالیبراسیون سه‌بعدی محور Z، آفست آهن سخت و ضریب مقیاس محور Z نامعلوم مانده و جبران شیب با خطاهای بسیار بزرگ مواجه می‌شود.

پرسش 3: علت استفاده از دکل ایزوله‌کننده (Compass Mast) در کوادکوپترها چیست؟
پاسخ: در کوادکوپترها، خطوط کابل اتصال باتری LiPo به چهار اسپیدکنترلر (ESC) جریان‌های مستقیمی از چند ده تا بیش از 100 آمپر را هدایت می‌کنند که طبق قانون بیو-ساوار، میدان‌های تداخلی بسیار قوی (گاهی بیش از 2 برابر میدان زمین) تولید می‌نمایند. از آنجا که شدت میدان دوقطبی با توان سوم فاصله (1/r3) و کابل با معکوس فاصله (1/r) افت می‌کند، نصب سنسور روی یک دکل با ارتفاع 15 سانتی‌متر بالاتر از بدنه، تداخلات الکترومغناطیسی را تا بیش از 95% کاهش می‌دهد.


تمرین‌های تکمیلی و مسائل حل‌نشده با پاسخ کلیدی

تمرین 1: یک پهپاد در پرواز افقی با سمت واقعی ψ=90.00∘ (رو به شرق) قرار دارد. مشخصات میدان منطقه Bh=30.00 μT و Bz=45.00 μT است. اگر پهپاد دچار زاویه فراز (Pitch) رو به بالا معادل θ=+12.00∘ شود (با زاویه رول صفر)، مؤلفه طولی بدنه (Bxb) چقدر خواهد بود و در صورت عدم جبران شیب، سمت خام چند درجه محاسبه می‌شود؟
پاسخ کلیدی: Bxb=Bhcosψcosθ−Bzsinθ=(30.00×cos(90∘)×cos(12∘))−(45.00×sin(12∘))=0.00−9.36=−9.36 μT، Byb=−30.00 μT، ψraw=atan2(+30.00,−9.36)=107.33∘ (خطای +17.33∘).

تمرین 2: در یک فرآیند کالیبراسیون دو بعدی، بیشینه و کمینه داده‌های قرائت‌شده روی محورهای X و Y به صورت زیر ثبت شده است:
Bx,max=+52.0 μT,Bx,min=−16.0 μT
By,max=+28.0 μT,By,min=−40.0 μT
بردار آفست آهن سخت (Vhx,Vhy) و فاکتورهای مقیاس آهن نرم (Sx,Sy) را با روش Min-Max محاسبه کنید.
پاسخ کلیدی: Vhx=+18.00 μT، Vhy=−6.00 μT، Sx=34.00 μT، Sy=34.00 μT.

تمرین 3: پس از اعمال کالیبراسیون بیضوی بر روی 5 نقطه آزمایشی، خطاهای شعاعی باقیمانده به صورت زیر بر حسب میکروتسلا به دست آمده است:
ϵ1=+0.20 μT,ϵ2=−0.30 μT,ϵ3=+0.10 μT,ϵ4=−0.20 μT,ϵ5=+0.40 μT.
ریشه میانگین مربعات خطای باقیمانده (RMSresidual) را محاسبه کرده و کیفیت کالیبراسیون را ارزیابی کنید.
پاسخ کلیدی: RMSresidual=0.04+0.09+0.01+0.04+0.165=0.345=0.068≈0.261 μT (عالی، کمتر از 0.5 μT).


جمع‌بندی مهندسی

ناوبری دقیق با قطب‌نمای الکترونیکی نیازمند نگرش سیستمی به برهم‌کنش سنسور با فیزیک محیط پیرامون است. در گام اول، رعایت الزامات سخت‌افزاری و جانمایی (Keep-out zone، دکل قطب‌نما در پهپادها و سیم‌کشی زوجی دیفرانسیلی) نویزها و تداخلات را در مبدأ به حداقل می‌رساند. در گام دوم، الگوریتم‌های جبران شیب با بهره‌گیری از داده‌های تراز شتاب‌سنج، نشت خطرناک مؤلفه قائم میدان زمین را در مانورهای دینامیکی خنثی می‌کنند. در نهایت، کالیبراسیون سه‌بعدی کمترین مربعات بیضوی با استخراج بردار آفست آهن سخت و ماتریس تغییر مقیاس و دوران آهن نرم، ابرنقاط اعوجاج‌یافته را بر روی کره کامل میدان زمین نگاشت کرده و دقت زاویه‌ای در حد زیر یک درجه را در تمامی جهات تضمین می‌نماید.


مراجع و منابع مطالعه‌شده

  1. STMicroelectronics. (2010). Using LSM303DLH for a Tilt-Compensated Electronic Compass. Application Note AN3192 (Rev 2).
  2. STMicroelectronics. (2017). How to Calibrate an Electronic Compass. Application Note AN5012.
  3. NXP Semiconductors / Freescale. (2012). Implementing a Tilt-Compensated eCompass using Accelerometer and Magnetometer Sensors. Application Note AN4248.
  4. NXP Semiconductors / Freescale. (2012). Calibrating an eCompass in the Presence of Hard- and Soft-Iron Distortions. Application Note AN4246.
  5. Honeywell International. (2010). Low Cost Compass System with Tilt Compensation. Application Note AN211 & AN203.
  6. National Oceanic and Atmospheric Administration (NOAA) & British Geological Survey (BGS). (2020). The World Magnetic Model (WMM 2020-2025): Technical Report.

با نظرات خود به تیم جبرا در بهبود کیفیت کمک کنید

نشانی ایمیل شما منتشر نخواهد شد. بخش‌های موردنیاز علامت‌گذاری شده‌اند *

سبد خرید
پیمایش به بالا