شیب‌سنج‌ها و ساختار واحدهای اندازه‌گیری اینرسی: از اصول شیب‌سنجی مایعی و شتاب‌سنجی تا تلفیق شتاب‌سنج، ژیروسکوپ، مغناطیس‌سنج و درجات آزادی 6DOF/9DOF

15.1. روش‌های اندازه‌گیری شیب

اندازه‌گیری زاویه شیب (Inclination / Tilt Angle) یکی از بنیادی‌ترین سنجه‌ها در مهندسی ابزاردقیق، ژئوتکنیک، رباتیک و ناوبری کالبدهای متحرک به شمار می‌رود. شیب در مفهوم فیزیکی عبارت است از زاویه انحراف یک محور یا یک صفحه مبنا نسبت به راستای بردار محلی شتاب گرانش زمین (g→) یا صفحه افق محلی مماس بر زمین‌واره (Geoid). سنجش زاویه شیب بر مبنای اصل بنیادی پایش بردار گرانش استوار است؛ هرگاه جسمی نسبت به افق کج شود، تصویر بردار شتاب ثقل بر محورهای مختصات محلی آن تغییر می‌یابد. با این حال، فناوری‌های متعددی برای دستیابی به این سنجه توسعه یافته‌اند که از ترازهای مکانیکی و الکترولیتی با دقت‌های بسیار بالا در شرایط ایستا، تا شتاب‌سنج‌های حالت جامد و سیلیکونی خازنی را در بر می‌گیرند. در این بخش، اصول فیزیکی روش‌های سنتی و پیشرفته شیب‌سنجی، روابط ریاضی حاکم بر استخراج زاویه از داده‌های شتاب، و چالش‌های ناشی از تداخلات دینامیکی و ارتعاشات محیطی به تفصیل تحلیل می‌شوند.

       راستای شاقول محلی (بردار گرانش زمین g)
                     |
                     v
             +---------------+
             |  افق محلی     |
    ---------+---------------+---------
             \   زاویه شیب   /
              \   (\theta)  /
               \           /
                \         /
                 +-------+
                 | کالبد |
                 | سنسور |
                 +-------+

15.1.1. روش‌های مکانیکی، مایعی و الکترولیتی

پیش از رواج شتاب‌سنج‌های مجتمع میکرومکانیکی (MEMS)، سنجش شیب با بهره‌گیری مستقیم از قوانین هیدرواستاتیک و آونگ‌های مکانیکی صورت می‌پذیرفت. این روش‌ها هنوز هم در کاربردهای با دقت فوق‌بالا (نظیر پایش نشست سدها، پل‌ها، تونل‌ها و ترازهای لیزری دقیق ساختمانی) جایگاه ویژه‌ای دارند.

1. شیب‌سنج‌های مکانیکی پاندولی (Pendulous Inclinometers)

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

  • انواع ترانسدیوسر: پتانسیومتری کم‌اصطکاک، ترانسفورماتور دیفرانسیلی متغیر خطی یا دوار (LVDT / RVDT)، و انکودرهای نوری زاویه‌ای با تفکیک‌پذیری بالا.
  • دینامیک سیستم: حرکت آونگ از معادله دیفرانسیل مرتبه دوم خطی‌شده پیروی می‌کند:
    Jd2θdt2+cdθdt+mgLsin(θ)=τext

    که در آن J گشتاور اینرسی، c ضریب میرایی، m جرم، L فاصله مرکز جرم تا محور دوران، و τext گشتاورهای اغتشاشی خارجی است. فرکانس تشدید طبیعی سیستم به صورت زیر تعیین می‌شود:

    ωn=mgLJ≈gL
  • چالش‌ها و محدودیت‌ها: آونگ‌های مکانیکی به دلیل فرکانس تشدید پایین (معمولاً زیر 5 هرتز)، پهنای باند بسیار محدودی دارند و هرگونه شتاب افقی یا ارتعاش محیطی می‌تواند آونگ را به نوسان وا دارد. از این رو، استفاده از سیستم‌های میرایی روغنی ویسکوز (Viscous Damping) یا میرایی جریان گردابی مغناطیسی (Eddy Current Braking) برای مهار نوسانات تشدید الزامی است.

2. شیب‌سنج‌های مایعی و ترازهای حبابی نوری (Liquid Bubble & Optical Spirit Levels)

ترازهای حبابی سنتی از یک کپسول شیشه‌ای یا فلزی با انحنای کروی بسیار دقیق تشکیل شده‌اند که با مایعی با گرانروی پایین و کشش سطحی مناسب (نظیر اتانول یا هپتان) پر شده و یک حباب کوچک گاز در آن باقی مانده است. به دلیل چگالی کمتر گاز نسبت به مایع، نیروی شناوری ارشمیدس حباب را همواره به بالاترین نقطه کپسول هدایت می‌کند.
در نسخه‌های الکترونوری مدرن، موقعیت حباب در کپسول توسط آرایه‌ای از دیودهای فرستنده نور مادون قرمز (IR LED) و گیرنده‌های نوری فتودیودی یا سنسورهای تصویری خطی (CCD/CMOS) پایش می‌شود. با کج شدن بدنه، موقعیت حباب جابجا شده و مقدار نور دریافتی فتودیودهای تفاضلی تغییر می‌کند.

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

3. حسگرهای شیب الکترولیتی (Electrolytic Tilt Sensors)

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

       ساختار شماتیک شیب‌سنج الکترولیتی تفاضلی
       
                 +-----------------------+
                 |       حباب گاز        |
                 |      .-------.        |
                 |     (  BUBBLE )       |
                 |      '-------'        |
       الکترود A |~~~~~~~~~~~~~~\~~~~~~~~| الکترود B
       (چپ)     |  مایع رسانا  \       | (راست)
      [======]   | (الکترولیت)   \      |   [======]
                 +----------------\------+
                             |
                         الکترود C
                       (مشترک مرکزی)
  • اصل عملکرد الکتریکی: در حالت تراز افقی، حباب دقیقاً در مرکز تقارن حسگر قرار می‌گیرد و سطح تماس مایع الکترولیت با الکترودهای کناری A و B کاملاً یکسان است؛ در نتیجه مقاومت الکتریکی میان الکترود A و الکترود مشترک C با مقاومت میان B و C برابر است (RAC=RBC). هنگامی که حسگر کج می‌شود، حباب به یک سمت حرکت کرده و مایع الکترولیت سمت دیگر را بیشتر می‌پوشاند. در نتیجه، سطح تماس موثر تغییر کرده و مقاومت یکی از بازوها کاهش و دیگری افزایش می‌یابد:
    ΔR∝θ
  • تحریک پل وتستون با ولتاژ متناوب (AC Excitation): یک الزام حیاتی در حسگرهای الکترولیتی، پرهیز مطلق از اعمال ولتاژ مستقیم (DC) به الکترودها است؛ زیرا ولتاژ DC موجب پدیده الکترولیز مایع، قطبش یونی، تولید حباب‌های ناخواسته، و فرسایش گالوانیکی الکترودها می‌گردد. مدار بازخوانی باید همواره از سیگنال متناوب سینوسی یا مربعی متقارن با فرکانس بین 500 هرتز تا 5 کیلوهرتز استفاده نماید و خروجی تفاضلی پل را از طریق دمدولاتور همگام (Phase-Sensitive Demodulator) آشکار سازد.
شاخص فنی شیب‌سنج مکانیکی پاندولی شیب‌سنج مایعی نوری شیب‌سنج الکترولیتی دقیق
گستره اندازه‌گیری (Range) وسیع (±30∘ تا ±90∘) متوسط (±10∘ تا ±45∘) بسیار محدود تا متوسط (±0.5∘ تا ±30∘)
تفکیک‌پذیری (Resolution) حدود 0.01∘ تا 0.05∘ حدود 0.005∘ تا 0.02∘ فوق‌العاده بالا (<0.0001∘ یا 0.1 ثانیه قوسی)
پهنای باند فرکانسی بسیار کم (<3 Hz) کم (<1 Hz) کم تا متوسط (<5 Hz)
حساسیت به شوک مکانیکی آسیب‌پذیر در برابر ضربه و لرزش مقاوم و با دوام بسیار مقاوم
حساسیت به دما پایین تا متوسط متوسط (تغییر ویسکوزیته مایع) نیازمند جبران‌سازی فعال دمایی
کاربرد اصلی ماشین‌آلات سنگین ساختمانی و جرثقیل ترازهای صنعتی و نقشه‌برداری پایش سلامت سازه، ژئوتکنیک و سدها

15.1.2. شیب‌سنجی با شتاب‌سنج

با ظهور شتاب‌سنج‌های خازنی سیلیکونی مبتنی بر فناوری MEMS (مانند آنچه در مراجع R01 و R20 تشریح شده است)، شیب‌سنجی دیجیتال و ارزان‌قیمت در ابعاد میلی‌متری امکان‌پذیر شد. در شرایط ایستا (Static Conditions) که سنسور فاقد شتاب خطی خارجی است، تنها نیروی وارد بر جرم لرزان شتاب‌سنج، شتاب گرانش زمین (g→≈9.80665 m/s2≈1g) است. با تجزیه این بردار ثابت روی محورهای سنسور، می‌توان زاویه دقیق وضعیت را محاسبه نمود.

1. شیب‌سنجی تک‌محوره و تحلیل حساسیت دیفرانسیلی

در ساده‌ترین حالت، اگر سنسور حول یک محور افقی دوران کند و محور حساس شتاب‌سنج (X) در صفحه دوران قرار گیرد:

Ax=1g·sin(θ)

بنابراین زاویه شیب برحسب خروجی اندازه‌گیری‌شده شتاب‌سنج برابر است با:

θ=arcsin(Ax1g)

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

Stilt=dAxdθ=1g·cos(θ)

حساسیت دیفرانسیلی به شیب (g / radian)
 1.0 g | * * * *
       |         * *
 0.8 g |            *
       |              *
 0.6 g |                *
       |                 *
 0.4 g |                  *
       |                   *
 0.2 g |                    *
       |                     *
 0.0 g +-----------------------*--> زاویه شیب \theta
       0°   20°   40°   60°   80°  90°
      حداکثر حساسیت         حساسیت صفر (نقطه کور)
  • پدیده افت حساسیت در زوایای بزرگ: در زاویه نزدیک به افق (θ≈0∘)، cos(0∘)=1 است؛ یعنی حساسیت سنسور به شیب در بیشترین مقدار خود قرار دارد (S≈17.45 mg/deg). اما هنگامی که شیب به 90∘ نزدیک می‌شود، cos(90∘)=0 شده و حساسیت به صفر میل می‌کند.
  • واگرایی خطای زاویه: اگر شتاب‌سنج دارای نویز یا خطای آفست ΔAx باشد، خطای محاسبه زاویه شیب از بسط دیفرانسیلی به دست می‌آید:
    Δθ≈ΔAxcos(θ)

    با میل کردن θ به سمت 90∘، مخرج کسر به صفر نزدیک شده و کوچک‌ترین خطای اندازه‌گیری شتاب، خطای عظیمی در تخمین زاویه ایجاد می‌کند. به همین دلیل، شیب‌سنجی تک‌محوره در زوایای بزرگتر از ±60∘ کاملاً غیرقابل اعتماد است. همچنین تابع arcsin نمی‌تواند زاویه شیب مثبت را از شیب معکوس در گستره فراتر از 90∘ تمایز دهد.

  • تداخل شیب متقاطع (Cross-Axis Tilt Coupling) و حساسیت متقاطع فیزیکی: اگر کالبد حسگر علاوه بر شیب اصلی حول محور Y (زاویه θ)، دچار کج‌شدگی ناخواسته حول محور X (زاویه ϕ) نیز شود، بردار گرانش به صورت دوبعدی تصویر شده و شتاب اندازه‌گیری‌شده در محور X برابر با Ax=1g·sin(θ)cos(ϕ) خواهد بود. در نتیجه استفاده ساده از arcsin(Ax/1g)، شیب θ را به اشتباه کمتر از مقدار واقعی تخمین می‌زند. علاوه بر این، در شتاب‌سنج‌های MEMS به دلیل تلرانس‌های ساخت میکرومکانیکی، تعامد ساختاری محورها کاملاً 90∘ نبوده و یک «حساسیت متقاطع» (Cross-Axis Sensitivity) فیزیکی معمولاً در حدود 1% تا 3% وجود دارد که در آن شتاب عمود بر محور به شکل تداخلی وارد محور حساس می‌گردد.

2. شیب‌سنجی دومحوره (Dual-Axis Inclinometry)

برای غلبه بر محدودیت‌های شیب‌سنج تک‌محوره، دو محور عمود بر هم (X و Y) به کار گرفته می‌شوند که هر دو در صفحه دوران قرار دارند. خروجی شتاب‌سنج‌ها در این وضعیت عبارت است از:

Ax=1g·sin(θ)
Ay=1g·cos(θ)

با تقسیم این دو رابطه بر یکدیگر:

AxAy=1g·sin(θ)1g·cos(θ)=tan(θ)⟹θ=arctan(AxAy)

یا با حفظ علامت علائم محورها در چهار ربع دایره:

θ=atan2(Ax,Ay)

مزایای بنیادین روش دومحوره:

  1. پایداری حساسیت در کل گستره 360∘: در هر نقطه‌ای که حساسیت یکی از محورها کاهش یابد (مثلاً X در حوالی 90∘)، حساسیت محور دیگر (Y) به اوج خود می‌رسد، به طوری که حساسیت سیستم همواره یکنواخت و غیرصفر باقی می‌ماند.
  2. استقلال از دامنه شتاب گرانش محلی: از آنجا که نسبت دو مؤلفه شتاب گرفته می‌شود، ضریب 1g از صورت و مخرج ساده می‌شود. بنابراین تغییرات جزئی شتاب ثقل در نقاط مختلف کره زمین یا رانش ضریب مقیاس مشترک سنسور، خطایی در محاسبه زاویه وارد نمی‌کند.

3. شیب‌سنجی سه‌محوره در فضای سه‌بعدی (Tri-Axis Tilt Sensing)

در کاربردهای واقعی، سنسور آزاد است در هر سه بعد دوران کند. فرض می‌کنیم چارچوب مختصات راست‌گرد سنسور به گونه‌ای است که محور X به سمت جلو، محور Y به سمت راست و محور Z عمود بر صفحه و رو به بالا جهت‌گیری شده‌اند؛ در نتیجه در حالت تراز افقی و سکون کامل، خروجی شتاب‌سنج‌ها برابر با Ax=0، Ay=0 و Az=+1g است. وضعیت فضایی بدنه را می‌توان با دو زاویه زاویه فراز (Pitch, θ) و زاویه غلتش (Roll, ϕ) بیان کرد. زاویه سمت (Yaw / Heading) حول بردار گرانش دوران می‌کند و بنابراین شتاب‌سنج به تنهایی قادر به سنجش آن نیست.

روابط استاندارد برای استخراج زوایای فراز و غلتش بر اساس بردار اندازه‌گیری‌شده A→=[Ax,Ay,Az]T و با استفاده از تابع دوآرگومانی atan2(صورت,مخرج) — که در کتابخانه‌های استاندارد برنامه‌نویسی به صورت atan2(y, x) پیاده‌سازی شده و ربع مثلثاتی صحیح را در بازه [−π,+π] تعیین می‌کند — عبارتند از:

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

  • آزمون هنجار بردار گرانش (Gravity Vector Norm Check): در شرایط ایستا، اندازه بردار برآیند شتاب باید دقیقاً برابر با شتاب گرانش محلی (1g) باشد:
    ‖A→‖=Ax2+Ay2+Az2≈1g

    این رابطه یک ابزار تشخیصی بسیار قدرتمند برای سیستم‌های نهفته است؛ هرگاه قدر مطلق بردار تفاوت فاحشی با 1g داشته باشد، کنترل‌کننده متوجه می‌شود که سیستم تحت تأثیر شتاب‌های دینامیکی خارجی یا شوک قرار دارد و نباید به شیب محاسبه‌شده استناد کند.


15.1.3. اثر شتاب حرکت و ارتعاش بر نتیجه

بزرگ‌ترین و اساسی‌ترین چالش فیزیکی در بهره‌گیری از شتاب‌سنج برای شیب‌سنجی، اصل هم‌ارزی اینشتین (Einstein Equivalence Principle) است: یک شتاب‌سنج قادر نیست شتاب ناشی از گرانش زمین را از شتاب‌های ناشی از سینماتیک حرکت کالبد تمایز دهد. شتاب خروجی اندازه‌گیری‌شده همواره برآیند برداری تمام شتاب‌های وارده است:

A→meas=−g→+a→kin+a→centrifugal+a→vib+b→+η→

که در آن −g→ شتاب عکس‌العمل تکیه‌گاهی ناشی از گرانش، a→kin شتاب خطی دینامیکی، a→centrifugal شتاب گریز از مرکز، a→vib ارتعاشات مکانیکی محیط، b→ آفست یا بایاس سنسور، و η→ نویز اتفاقی است.

1. خطای شتاب خطی دینامیکی (Dynamic Acceleration Error)

هنگامی که وسیله نقلیه یا ربات شتاب‌گیری یا ترمز می‌کند، شتاب خطی a→kin با شتاب گرانش ترکیب شده و بردار ظاهری گرانش را کج می‌کند. زاویه اندازه‌گیری‌شده توسط شتاب‌سنج در این حالت زاویه شیب ظاهری (Apparent Tilt Angle) خواهد بود:

θapparent=arctan(AxAz)=arctan(akin,xg)

       اثر شتاب دینامیکی بر بردار برآیند
       
       \theta_{apparent}   بردار شتاب دینامیکی a_{kin}
              \      <==============+
               \                    |
                \                   | بردار گرانش
       بردار برآیند \                 | واقعی زمین
        اندازه‌گیری   \               | g
          A_{meas}    \             |
                        \           |
                         v          v

مثال عددی تحلیلی:
فرض کنید خودرویی بر روی یک جاده کاملاً افقی و مسطح (θreal=0∘) با شتاب خطی ملایم ax=0.98 m/s2≈0.1g شتاب می‌گیرد.
در این شرایط، شتاب‌سنج شتاب‌های زیر را ثبت می‌کند:
Ax=akin,x=0.1g
Az=g=1.0g
شیب محاسبه‌شده توسط الگوریتم شیب‌سنجی شتاب‌سنج برابر خواهد بود با:

θapparent=arctan(0.1g1.0g)=arctan(0.1)≈5.71∘

مشاهده می‌شود که یک شتاب خطی معمولی در رانندگی شهری، خطای فاحشی معادل 5.71 درجه در تخمین شیب ایجاد می‌کند! اگر شیب واقعی جاده 3∘ باشد، شتاب‌سنج شیب را 8.71∘ گزارش خواهد کرد.

2. شتاب‌های دورانی، جانب مرکز و گریز از مرکز (Centripetal & Centrifugal Accelerations)

اگر حسگر در فاصله‌ای معادل بردار r→ نسبت به مرکز دوران کالبد متحرک نصب شده باشد، در هنگام دور زدن کالبد با سرعت زاویه‌ای ω→، شتاب‌های تداخلی اضافی به سنسور اعمال می‌شوند. از منظر سینماتیک نیوتنی، کالبد دارای شتاب جانب مرکز (Centripetal) به سمت مرکز دوران به صورت a→cen=ω→×(ω→×r→) و شتاب مماس به صورت a→tan=α→×r→ (که در آن α→=dω→dt شتاب زاویه‌ای است) می‌باشد. در چارچوب نالخت متصل به سنسور، جرم لرزان شتاب‌سنج نیروی اینرسی گریز از مرکز ظاهری متناظر به صورت −ω→×(ω→×r→) را تجربه می‌کند. در پیچیدن یک خودرو یا پهپاد، این شتاب افقی می‌تواند حتی از 0.5g فراتر رود و شیب‌سنجی مبتنی بر شتاب‌سنج را به کلی دچار انحراف سازد.

3. اثر ارتعاشات مکانیکی و خطای یکسوسازی ارتعاش (Vibration Rectification Error – VRE)

موتورها، ملخ‌ها، پمپ‌ها و چرخ‌دنده‌ها ارتعاشات هارمونیک شدیدی با دامنه‌های بالا در فرکانس‌های مختلف تولید می‌کنند. اگر رفتار سیستم خازنی یا مدارهای تقویت‌کننده سنسور MEMS کاملاً خطی نباشد، ارتعاشات متقارن نوسانی با فرکانس بالا در مرحله تقویت یا بازخوانی غیرخطی دچار پدیده «یکسوسازی» شده و یک مؤلفه آفست کاذب DC در خروجی شتاب ظاهر می‌گردد. این آفست تصنعی باعث می‌شود حتی پس از اعمال فیلترهای پایین‌گذر دیجیتال نیز یک خطای شیب دائمی در سیستم باقی بماند.

4. محدودیت‌های فیلتر پایین‌گذر دیجیتال (Low-Pass Filter Limitations)

یک رویکرد سنتی برای کاهش اثر شتاب‌های دینامیکی، استفاده از فیلترهای پایین‌گذر قوی (مانند فیلتر Butterworth یا میانگین متحرک با فرکانس قطع پایین مثلاً 0.5 Hz) است. اگرچه این فیلتر ارتعاشات فرکانس بالا را به خوبی تضعیف می‌کند، اما دو ایراد مهندسی اساسی به همراه دارد:

  1. تأخیر زمانی و فاز شدید (Phase Lag): سیستم دیگر قادر به واکنش سریع به تغییر شیب‌های آنی کالبد نخواهد بود.
  2. عدم کارایی در برابر شتاب‌های حرکتی پیوسته: شتاب‌گیری خودرو در بزرگراه یا گردش دورانی طولانی‌مدت یک پدیده فرکانس پایین است که به راحتی از فیلتر عبور کرده و الگوریتم را گمراه می‌سازد.

این تحلیل بنیادین ثابت می‌کند که یک شتاب‌سنج به تنهایی هرگز قادر به اندازه‌گیری دقیق و بلادرنگ زاویه شیب در شرایط دینامیکی نیست. این واقعیت فیزیکی ضرورت اجتناب‌ناپذیر ادغام شتاب‌سنج با یک حسگر مکمل دینامیکی سریع (یعنی ژیروسکوپ) در قالب «واحد اندازه‌گیری اینرسی (IMU)» را ایجاب می‌کند که موضوع بخش بعدی است.


15.2. ساختار IMU و نقش حسگرها

واحدهای اندازه‌گیری اینرسی (Inertial Measurement Units – IMU) هسته اصلی سامانه‌های ناوبری، پایداری و هدایت را در هوانوردی، هوافضا، رباتیک و دستگاه‌های هوشمند مصرفی تشکیل می‌دهند. در دهه‌های گذشته، سیستم‌های اینرسی از سکوهای گیمبال‌دار مکانیکی بزرگ، سنگین و گران‌قیمت تشکیل می‌شدند که از ژیروسکوپ‌های مکانیکی چرخان با سرعت بالا برای حفظ افق مصنوعی استفاده می‌کردند. با پیشرفت فناوری میکرومکانیک سیلیکونی (MEMS)، ساختار واحدهای اینرسی به سامانه‌های «نصب مستقیم بر بدنه» (Strapdown) دگرگون شد؛ بدین معنا که حسگرهای اینرسی مستقیماً و بدون هیچ واسطه مفصلی متحرکی به سازه کالبد متصل شده و تمامی محاسبات مربوط به زوایای دوران و انتقال مختصات، به صورت دیجیتال و الگوریتمی در پردازنده انجام می‌پذیرد. در این بخش، مبانی معماری IMU، نقش‌های مکمل شتاب‌سنج و ژیروسکوپ، منطق افزودن مغناطیس‌سنج، و تمایز بنیادین میان درجات آزادی سینماتیکی کالبد با تعداد کانال‌های حسگری به تفصیل بررسی می‌شوند.

       معماری کلی واحد اندازه‌گیری اینرسی چندمحوره (IMU / MARG)
       
       +-------------------------------------------------------+
       |               سازه کالبد متحرک (Vehicle Body)          |
       |                                                       |
       |  +---------------------+     +---------------------+  |
       |  |  شتاب‌سنج 3 محوره    |     |   ژیروسکوپ 3 محوره  |  |
       |  |   (Ax, Ay, Az)      |     |   (Wx, Wy, Wz)      |  |
       |  +----------+----------+     +----------+----------+  |
       |             |                           |             |
       |             +-------------+-------------+             |
       |                           |                           |
       |                           v                           |
       |              +-------------------------+              |
       |              |   واحد پردازش دیجیتال   |              |
       |              | (FIFO / DSP / Fusion)   |              |
       |              +------------+------------+              |
       |                           ^                           |
       |                           | (در ماژول‌های 9 محوره)     |
       |              +------------+------------+              |
       |              |    مغناطیس‌سنج 3 محوره    |              |
       |              |       (Mx, My, Mz)      |              |
       |              +-------------------------+              |
       +-------------------------------------------------------+

15.2.1. ترکیب شتاب‌سنج و ژیروسکوپ

پیکربندی استاندارد یک IMU شش‌محوره (6-Axis IMU)، حاصل هم‌نشینی یک شتاب‌سنج سه‌محوره و یک ژیروسکوپ سه‌محوره است. دلیل مهندسی این ترکیب، مکمل بودن بی‌نظیر ویژگی‌های فیزیکی این دو حسگر است؛ ضعفی که در یکی از آن‌ها وجود دارد، دقیقاً توسط قوت دیگری پوشش داده می‌شود.

1. مکمل بودن رفتار فیزیکی و طیف فرکانسی

همان‌طور که در زیرفصل 15.1 به اثبات رسید، شتاب‌سنج در شرایط استاتیک یا حرکات بسیار آرام، سنجش‌گری ایده‌آل برای بردار گرانش زمین است و زاویه شیب را بدون هیچ‌گونه رانش بلندمدت (Drift-Free) ارائه می‌دهد. اما در شرایط دینامیک، شتاب‌های خطی، گریز از مرکز و ارتعاشات مکانیکی با فرکانس بالا خروجی آن را مخدوش می‌سازند. از سوی دیگر، ژیروسکوپ نرخ دوران زاویه‌ای کالبد را مستقیماً نسبت به فضای اینرسی در چارچوب کالبد اندازه می‌گیرد:

ω→ibb=[ωx,ωy,ωz]T

در تقریب زوایای کوچک (Small-Angle Approximation) یا در دوران‌های تک‌محوره ساده، مؤلفه‌های بردار سرعت زاویه‌ای تقریباً متناظر با مشتق زمانی زوایای اویلر هستند (ω→≈[ϕ˙,θ˙,ψ˙]T). در سینماتیک سه‌بعدی عام، بردار سرعت زاویه‌ای در چارچوب بدنه از طریق ماتریس سینماتیکی اویلر به نرخ تغییرات زوایا مرتبط می‌شود:

[ωxωyωz]=[10−sin(θ)0cos(ϕ)sin(ϕ)cos(θ)0−sin(ϕ)cos(ϕ)cos(θ)][ϕ˙θ˙ψ˙]

  • مزیت ژیروسکوپ در فرکانس‌های بالا: ژیروسکوپ به شتاب‌های خطی (a→kin) یا گرانش زمین واکنش نشان نمی‌دهد؛ بنابراین در حرکات ناگهانی، مانورهای سریع و ارتعاشات مکانیکی، نرخ زاویه‌ای را با وفاداری بسیار بالا و پاسخ فرکانسی گسترده (تا چند صد هرتز) گزارش می‌کند.
  • ضعف ذاتی ژیروسکوپ در فرکانس‌های پایین و انتگرال‌گیری: برای به دست آوردن زاویه وضعیت (θ) از سرعت زاویه‌ای (ω)، باید از خروجی ژیروسکوپ انتگرال زمانی گرفته شود:
    θ(t)=θ(0)+∫0tω(τ)dτ

    هر ژیروسکوپ واقعی دارای یک خطای بایاس یا آفست اولیه غیرصفر (bg) و نویز تصادفی (ηg) است:

    ωmeas(t)=ωtrue(t)+bg(t)+ηg(t)

    با انتگرال‌گیری از این سیگنال در طول زمان، خطای بایاس به صورت خطی با زمان (bg·t) رشد می‌کند، و نویز سفید زاویه‌ای تبدیل به پدیده «گام‌زنی تصادفی زاویه» (Angle Random Walk – ARW) با رشدی متناسب با t می‌گردد. در نتیجه، حتی باکیفیت‌ترین ژیروسکوپ‌های MEMS در صورت عدم تصحیح بیرونی، پس از گذشت چند ثانیه تا چند دقیقه، زوایای کاملاً غیرواقعی تولید خواهند کرد.

مقایسه طیف خطای شتاب‌سنج و ژیروسکوپ در حوزه فرکانس

  خطا / نویز
      ^
      |    طیف خطای ژیروسکوپ               طیف خطای شتاب‌سنج
      |  (رانش شدید در فرکانس پایین/DC)   (نویز زیاد در فرکانس بالا)
      |         \                               /
      |          \                             /
      |           \                           /
      |            \                         /
      |             \                       /
      |              \                     /
      +---------------+-------------------+-------------------> فرکانس (Hz)
                     فرکانس قطع هم‌پوشانی (fc)
      <--- ناحیه معتبر شتاب‌سنج ---> <--- ناحیه معتبر ژیروسکوپ --->
  • هم‌افزایی (Synergy) در IMU: در یک واحد اندازه‌گیری اینرسی، خروجی ژیروسکوپ برای ردیابی دقیق و بلادرنگ چرخش‌های سریع (فرکانس بالا) استفاده می‌شود، در حالی که خروجی شتاب‌سنج به عنوان لنگر پایدار فرکانس پایین (DC Reference) برای شناسایی و تصحیح پیوسته خطای بایاس و رانش ژیروسکوپ به کار می‌رود.

2. فناوری یکپارچه‌سازی سخت‌افزاری: از قطعات مجزا تا تراشه مشترک (SoC / SiP)

در نسل‌های آغازین، شتاب‌سنج و ژیروسکوپ در بسته‌بندی‌های جداگانه روی مدار چاپی لحیم می‌شدند. این شیوه باعث بروز خطای زاویه‌ای عدم تعامد فیزیکی (Misalignment) میان محورهای دو سنسور و اختلاف دمای عملیاتی آن‌ها می‌شد. در تراشه‌های مدرن اینرسی (نظیر خانواده TDK InvenSense ICM-20689 در مرجع R19 یا Bosch BMI088):

  • هر دو حسگر میکرومکانیکی روی یک ویفر سیلیکونی مشترک یا در یک قالب ساختار فشرده چندتراشه‌ای (System-in-Package – SiP) در کنار یک مدار مجتمع بازخوانی اختصاصی (ASIC) تعبیه می‌شوند.
  • محورهای حساس شتاب‌سنج و ژیروسکوپ با دقت میکرومتری توسط لیتوگرافی دقیق تراز شده و خطای تعامد میان آن‌ها به کمتر از 0.1∘ کاهش می‌یابد.
  • یک سنسور دمای داخلی دقیق در مجاورت ساختارهای سیلیکونی تعبیه می‌شود تا تغییرات بایاس و ضریب مقیاس ناشی از دما با جداول کالیبراسیون سخت‌افزاری جبران گردد.

15.2.2. افزودن مغناطیس‌سنج و قرارداد نام‌گذاری ماژول‌ها

اگرچه ترکیب شتاب‌سنج و ژیروسکوپ در یک IMU شش‌محوره وضعیت زاویه‌ای فراز (Pitch) و غلتش (Roll) را پایدار می‌سازد، اما یک نقص فیزیکی بزرگ همچنان باقی می‌ماند: زاویه سمت (Yaw / Heading).

1. معمای فیزیکی زاویه سمت و ضرورت بردار مرجع دوم

بردار شتاب گرانش زمین (g→) همواره در راستای قائم محلی قرار دارد. صرف‌نظر از زاویه استقرار اولیه سنسور در فضا، چنانچه کالبد حول بردار محلی گرانش دوران کند (تغییر در زاویه سمت یا چرخش در صفحه افق):

  • زاویه میان بردار گرانش و تک‌تک محورهای سه‌گانه سنسور کاملاً ثابت باقی می‌ماند؛ در نتیجه تصویر بردار گرانش بر محورهای سه‌گانه شتاب‌سنج ([Ax,Ay,Az]) در طول دوران کوچک‌ترین تغییری نمی‌کند.
  • بنابراین شتاب‌سنج از نظر فیزیکی نسبت به چرخش حول بردار گرانش کاملاً «کور» است و هیچ اطلاعاتی برای مشاهده‌پذیری، تصحیح یا مهار رانش ژیروسکوپ حول این محور ارائه نمی‌دهد. در نتیجه، زاویه سمت به تدریج در طول زمان دچار رانش نامحدود می‌شود.

برای حل این چالش، به یک بردار مرجع فیزیکی غیرموازی با گرانش نیاز است. میدان ژئومغناطیسی زمین (B→) این نقش حیاتی را ایفا می‌کند. از آنجا که خطوط میدان مغناطیسی زمین در اغلب نقاط کره دارای مؤلفه افقی نیرومندی به سمت شمال مغناطیسی هستند، یک مغناطیس‌سنج سه‌محوره می‌تواند بردار میدان را اندازه بگیرد. با داشتن دو بردار مستقل فیزیکی:

  1. بردار گرانش زمین (g→): تعیین‌کننده افق محلی و زوایای فراز و غلتش.
  2. بردار میدان مغناطیسی زمین (B→): تعیین‌کننده راستای شمال مغناطیسی و تثبیت‌کننده زاویه سمت (Yaw).
    سامانه قادر می‌شود وضعیت سه‌بعدی کامل و مطلق کالبد را نسبت به زمین استخراج نماید. چنین ماژول‌هایی در ادبیات مهندسی سامانه‌های MARG (Magnetic, Angular Rate, and Gravity) نامیده می‌شوند.
       تثبیت زاویه فضایی با دو بردار مرجع مستقل
       
                 بردار شمال مغناطیسی (B)
                        ^
                       /
                      /
                     /  زاویه سمت (Yaw)
                    /
                   +--------------------> محور شرق
                   |
                   |
                   v
             بردار گرانش (g)
            (قائم رو به پایین)

2. قراردادهای نام‌گذاری ماژول‌ها در صنعت و بازار

در کاتالوگ‌های تجاری و مقالات مهندسی، نام‌گذاری ماژول‌ها بر مبنای تعداد کانال‌های اندازه‌گیری رایج شده است:

عنوان تجاری ترکیب حسگرهای داخلی تعداد کل کانال‌ها کمیت‌های فیزیکی اندازه‌گیری‌شده
6-Axis IMU شتاب‌سنج 3 محوره + ژیروسکوپ 3 محوره 6 کانال شتاب خطی (Ax,Ay,Az) + نرخ زاویه‌ای (ωx,ωy,ωz)
9-Axis IMU / MARG شتاب‌سنج 3 محوره + ژیروسکوپ 3 محوره + مغناطیس‌سنج 3 محوره 9 کانال شتاب خطی + نرخ زاویه‌ای + چگالی شار مغناطیسی (Mx,My,Mz)
10-DOF / 10-Axis شتاب‌سنج 3 محوره + ژیروسکوپ 3 محوره + مغناطیس‌سنج 3 محوره + بارومتر 10 کانال مقادیر 9 محوره فوق + فشار استاتیک اتمسفری (Pbaro) جهت تخمین ارتفاع
11-DOF ترکیب 10 محوره فوق + دماسنج دقیق یا سنسور رطوبت 11 کانال پارامترهای حرکتی و شرایط محیطی محلی

15.2.3. تفاوت تعداد محورهای حسگری با درجات آزادی حرکت

یکی از رایج‌ترین اشتباهات مفهومی و اصطلاحات نادرست در ادبیات تجاری ابزاردقیق، یکی دانستن «تعداد محورها یا کانال‌های سنسوری» با «درجات آزادی حرکت» (Degrees of Freedom – DoF) است. نام‌گذاری ماژول‌ها به صورت «ماژول 9-DOF» یا «ماژول 10-DOF» اگرچه در بازار الکترونیک جا افتاده است، اما از دیدگاه مبانی مکانیک کلاسیک نیوتنی کاملاً غلط است.

1. تعریف صلب درجات آزادی در مکانیک کلاسیک

در فیزیک و مکانیک رباتیک، درجات آزادی یک کالبد صلب (Rigid Body) عبارت است از حداقل تعداد متغیرهای نرده‌ای مستقل مورد نیاز برای تعیین کامل موقعیت مکانی و جهت‌گیری زاویه‌ای آن در فضا نسبت به یک چارچوب مرجع لخت.
یک جسم صلب ناوابسته در فضای اقلیدسی سه‌بعدی (ℝ3) دارای دقیقاً و منحصراً 6 درجه آزادی (6-DoF) است:

  1. سه درجه آزادی انتقالی (Translational DoF): موقعیت مکانی مرکز جرم جسم در امتداد محورهای سه‌گانه:
    r→=[x,y,z]T
  2. سه درجه آزادی دورانی (Rotational DoF): جهت‌گیری زاویه‌ای کالبد حول محورهای سه‌گانه که با زوایای اویلر (غلتش ϕ، فراز θ و سمت ψ) یا کواترنیون یکه بیان می‌شود.

هیچ پدیده فیزیکی در مکانیک کلاسیک نمی‌تواند درجات آزادی یک جسم صلب معلق در فضا را به عدد 9 یا 10 افزایش دهد؛ مگر آنکه جسم مفصل‌بندی‌شده باشد یا کالبد صلب دیگری به آن متصل گردد.

       شش درجه آزادی واقعی یک کالبد صلب در فضا (6-DoF)
       
                       +Z (انتقال عمودی)
                       ^
                       |    +--- Yaw (\psi) دوران حول Z
                       |   /
                       |  v
                       |
                       +------------> +X (انتقال طولی / جلو)
                      /              \
                     /                +--- Roll (\phi) دوران حول X
                    /
                   v
                  +Y (انتقال عرضی / راست)
                   \
                    +--- Pitch (\theta) دوران حول Y

2. کالبدشکافی مفهوم کانال‌های افزوده (Sensor Redundancy)

هنگامی که از یک ماژول 9 محوره (شامل شتاب‌سنج، ژیروسکوپ و مغناطیس‌سنج) استفاده می‌کنیم، در حقیقت 9 حسگر مستقل را برای پایش همان 6 درجه آزادی مکانیکی به کار گرفته‌ایم:

  • شتاب‌سنج‌ها 3 کانال برای پایش مشتق دوم جابجایی انتقالی (x¨,y¨,z¨) و بردار گرانش فراهم می‌سازند.
  • ژیروسکوپ‌ها 3 کانال برای پایش مشتق اول زوایای دورانی و بردار سرعت زاویه‌ای (ω→) ارائه می‌دهند.
  • مغناطیس‌سنج‌ها 3 کانال برای پایش بردار میدان مغناطیسی محلی در همان فضای سه‌بعدی در اختیار ما می‌گذارند.

کانال‌های مغناطیس‌سنج یا بارومتر، بعد فیزیکی جدیدی به ابعاد هندسی فضا اضافه نمی‌کنند؛ بلکه مشاهدات اضافی یا افزونه (Auxiliary / Redundant Observations) هستند. نقش این داده‌های تکمیلی، مقیدسازی معادلات، از بین بردن نامعینی‌های ریاضی (نظیر رانش نامحدود انتگرال‌گیری)، و افزایش دقت و قابلیت اطمینان در الگوریتم‌های تخمین حالت (State Estimation) و فیلترهای تلفیق داده است. بنابراین، عبارت دقیق مهندسی برای چنین ماژولی «واحد اندازه‌گیری 9 محوره با 6 درجه آزادی» (9-Axis Sensor with 6 Degrees of Freedom Tracking) است.


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

پرسش 1: چرا در شیب‌سنجی تک‌محوره با فرمول θ=arcsin(Ax/1g)، حساسیت با نزدیک شدن زاویه به 90∘ واگرا می‌شود، و شیب‌سنجی دومحوره چگونه این چالش را مرتفع می‌سازد؟

پاسخ تحلیلی:
حساسیت دیفرانسیلی شتاب خروجی نسبت به زاویه شیب برابر با مشتق اول رابطه است:

Stilt=dAxdθ=1g·cos(θ)

در زاویه افق (θ=0∘)، مقدار cos(0∘)=1 است و حساسیت به اوج خود یعنی 17.45 mg/deg می‌رسد. اما با افزایش شیب به سمت 90∘، تابع کسینوس به صفر میل می‌کند (cos90∘=0). بسط خطای دیفرانسیلی نشان می‌دهد که خطای تخمین زاویه برابر با Δθ≈ΔAxcos(θ) است؛ بنابراین در مجاورت 90∘، مخرج کسر به صفر نزدیک شده و کوچک‌ترین نویز الکتریکی یا خطای آفست شتاب‌سنج باعث ایجاد خطای بسیار بزرگ در محاسبه زاویه می‌شود.
در روش دومحوره، دو سنسور عمود بر هم در صفحه دوران قرار دارند (Ax=1gsinθ و Ay=1gcosθ). با بهره‌گیری از رابطه تانژانت معکوس θ=atan2(Ax,Ay)، هرگاه حساسیت محور X کاهش یابد، محور Y در اوج حساسیت خود قرار می‌گیرد. در نتیجه حساسیت مرکب در سراسر دایره 360∘ غیرصفر و یکنواخت باقی می‌ماند و علاوه بر آن وابستگی به نوسانات دامنه شتاب گرانش محلی 1g حذف می‌گردد.

پرسش 2: چرا تحریک الکتریکی شیب‌سنج‌های الکترولیتی باید منحصراً با ولتاژ متناوب (AC) انجام شود و اعمال ولتاژ DC چه خطراتی به همراه دارد؟

پاسخ تحلیلی:
شیب‌سنج‌های الکترولیتی حاوی یک مایع هادی یونی هستند. اگر ولتاژ مستقیم (DC) به الکترودها اعمال شود:

  1. پدیده الکترولیز مایع رخ داده و مولکول‌های حلال تجزیه شیمیایی می‌شوند؛ این امر باعث ایجاد حباب‌های ریز ناخواسته، تغییر حجم حباب اصلی و تغییر کشش سطحی می‌گردد.
  2. پدیده قطبش دی‌الکتریک و تجمع یون‌های ناهم‌نام در سطح الکترودها (Electrical Double Layer) رخ داده و مقاومت ظاهری تماس در طول زمان رانش می‌کند.
  3. واکنش‌های اکسیداسیون و احیا باعث فرسایش گالوانیکی و خوردگی برگشت‌ناپذیر الکترودهای فلزی پلاتینی یا طلایی می‌شود.
    برای خنثی‌سازی این اثرات، مدار بازخوانی باید از یک سیگنال متناوب متقارن (AC با فرکانس بین 500 هرتز تا 5 کیلوهرتز) استفاده کند تا در هر نیم‌پریود جهت شارش بارها معکوس شده و خالص بار منتقل‌شده در طول زمان دقیقاً صفر بماند.

پرسش 3: چرا یک IMU شش‌محوره متشکل از شتاب‌سنج و ژیروسکوپ هرگز قادر به تثبیت یا تصحیح رانش زاویه سمت (Yaw) کالبد نیست؟

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

  • تصویر بردار گرانش بر تک‌تک محورهای سه‌گانه سنسور کاملاً ثابت می‌ماند؛ زیرا زاویه بین راستای گرانش و محورهای سنسور در حین چرخش حول خود بردار گرانش تغییری نمی‌کند.
  • بنابراین شتاب‌سنج نسبت به دوران حول محور گرانش کاملاً «کور» است و هیچ داده قابل مشاهده‌ای برای اصلاح یا مقیدسازی رانش ژیروسکوپ محور قائم ارائه نمی‌دهد. برای مهار رانش زاویه سمت، لزوماً به یک بردار فیزیکی مرجع دوم غیرموازی با گرانش نیاز است؛ میدان ژئومغناطیسی زمین که توسط مغناطیس‌سنج سه‌محوره پایش می‌شود، این بردار مرجع دوم را در سامانه‌های MARG فراهم می‌سازد.

پرسش 4: تفاوت دقیق میان «درجات آزادی حرکت کالبد صلب» و «تعداد محورهای حسگری» چیست؟ چرا نام‌گذاری ماژول‌ها به صورت 9-DOF یا 10-DOF از دیدگاه مهندسی مسامحه‌آمیز است؟

پاسخ تحلیلی:
در مکانیک کلاسیک نیوتنی، یک جسم صلب معلق در فضای اقلیدسی سه‌بعدی حداکثر و دقیقاً دارای 6 درجه آزادی حرکتی (6-DoF) است: 3 درجه آزادی انتقالی در امتداد محورهای X,Y,Z و 3 درجه آزادی دورانی حول این محورها (Roll, Pitch, Yaw). هیچ متغیر هندسی مستقلی فراتر از این 6 درجه وجود ندارد.
هنگامی که ماژولی با عنوان تجاری "9-DOF" یا "10-DOF" فروخته می‌شود، عدد 9 یا 10 نشان‌دهنده تعداد کانال‌ها یا سنسورهای اندازه‌گیری فیزیکی است (3 کانال شتاب، 3 کانال ژیروسکوپ، 3 کانال مغناطیس‌سنج، و 1 کانال فشارسنج)، نه درجات آزادی جدید در حرکت جسم. این سنسورهای اضافی مشاهدات تکمیلی (Redundant Observations) برای تخمین بهتر، رفع نامعینی‌ها و مهار رانش‌های همان 6 درجه آزادی مکانیکی هستند.


مسائل و تمرین‌های عددی حل‌شده گام‌به‌گام

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

صورت مسئله:
یک کاوشگر رباتیک چرخ‌دار بر روی یک سطح شیب‌دار با شیب واقعی θtrue=5.0∘ (دوران حول محور عرضی Y) با شتاب خطی ثابت رو به جلو akin,x=1.471 m/s2 (معادل 0.15g) شتاب می‌گیرد. حسگر شتاب‌سنج سه‌محوره کالیبره‌شده در مرکز ربات نصب شده و محور X آن به سمت جلو و محور Z آن عمود رو به بالا است (Ay=0). فرض کنید شتاب گرانش محلی g=9.80665 m/s2=1.0g باشد.

  1. مؤلفه‌های بردار شتاب اندازه‌گیری‌شده توسط شتاب‌سنج (Ax و Az) را محاسبه کنید.
  2. زاویه شیب ظاهری که الگوریتم شیب‌سنجی تک‌محوره شتاب‌سنج تخمین می‌زند را به دست آورید و خطای زاویه‌ای حاصل از شتاب دینامیکی را بیابید.
  3. اندازه بردار برآیند شتاب (Norm) را محاسبه کرده و نشان دهید چگونه آزمون هنجار بردار گرانش (Gravity Vector Norm Check) عدم اعتبار این اندازه‌گیری را آشکار می‌سازد.

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

گام 1: محاسبه مؤلفه‌های بردار شتاب اندازه‌گیری‌شده:
بردار گرانش نسبت به محورهای سنسور در زاویه شیب 5.0∘:
مؤلفه ناشی از گرانش بر محور X:

Agrav,x=1.0g·sin(5.0∘)=1.0g×0.087156=0.08716g

مؤلفه ناشی از گرانش بر محور Z:

Agrav,z=1.0g·cos(5.0∘)=1.0g×0.996195=0.99620g

شتاب دینامیکی کالبد در راستای محور X با مؤلفه گرانش جمع برداری می‌شود:

Ax,meas=Agrav,x+akin,x=0.08716g+0.15000g=0.23716g
Az,meas=Agrav,z=0.99620g

گام 2: محاسبه زاویه شیب تخمینی و خطای دینامیکی:
زاویه شیب تخمینی شتاب‌سنج از رابطه تانژانت معکوس به دست می‌آید:

θapparent=atan2(Ax,meas,Az,meas)=arctan(0.23716g0.99620g)=arctan(0.23806)≈13.39∘

خطای مطلق ناشی از شتاب حرکت برابر است با:

Error=θapparent−θtrue=13.39∘−5.00∘=+8.39∘

مشاهده می‌شود که شتاب خطی معمولی 0.15g خطای بزرگی معادل 8.39 درجه (بیش از 160% خطای نسبی) در شیب‌سنجی ایجاد کرده است!

گام 3: آزمون هنجار بردار شتاب (Gravity Norm Check):
اندازه بردار برآیند شتاب اندازه‌گیری‌شده برابر است با:

‖A→meas‖=Ax,meas2+Ay,meas2+Az,meas2=(0.23716g)2+02+(0.99620g)2=0.05624+0.99241=1.04865≈1.0240g

انحراف اندازه بردار از مقدار استاندارد 1.0g برابر با +2.4% است. اگر آستانه پذیرش دینامیکی در فیلتر سیستم روی ±1% تنظیم شده باشد، پردازنده متوجه می‌شود که شرایط استاتیک برقرار نبوده و داده شیب شتاب‌سنج را بی‌اعتبار تلقی می‌کند.


تمرین 2: تحلیل رانش انتگرال‌گیری ژیروسکوپ در بازه 60 ثانیه

صورت مسئله:
یک ژیروسکوپ MEMS دارای خطای بایاس استاتیک نقطه صفر bg=0.05 deg/s و چگالی طیفی نویز با شاخص گام‌زنی تصادفی زاویه ARW=0.15 deg/hr است.

  1. اگر کالبد کاملاً ساکن باشد و زاویه وضعیت صرفاً از طریق انتگرال‌گیری عددی خروجی ژیروسکوپ (θ(t)=∫0tω(τ)dτ) تخمین زده شود، خطای ناشی از بایاس قطعی پس از گذشت زمان‌های t=10 s و t=60 s چقدر خواهد بود؟
  2. انحراف معیار خطای تصادفی ناشی از پدیده ARW را در پایان ثانیه 60 محاسبه نمایید.
  3. کل خطای زاویه‌ای محتمل سیستم در پایان 60 ثانیه را تخمین بزنید و نتیجه‌گیری مهندسی را بیان کنید.

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

گام 1: محاسبه خطای رانش خطی ناشی از بایاس:
خطای ناشی از بایاس قطعی ژیروسکوپ به صورت خطی با زمان رشد می‌کند:

Δθbias(t)=bg·t

  • برای t=10 s:
    Δθbias(10)=0.05 deg/s×10 s=0.50∘
  • برای t=60 s:
    Δθbias(60)=0.05 deg/s×60 s=3.00∘

گام 2: محاسبه انحراف معیار خطای تصادفی ناشی از ARW:
ابتدا زمان 60 ثانیه را به ساعت تبدیل می‌کنیم:

thr=60 s3600 s/hr=160 hr≈0.01667 hr

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

σθ(t)=ARW×thr=0.15 deg/hr×160 hr=0.15×0.1291≈0.0194∘

گام 3: برآورد خطای کل و نتیجه‌گیری مهندسی:
خطای کل زاویه‌ای با در نظر گرفتن باند اطمینان 3σ برابر است با:

Δθtotal≈Δθbias±3σθ=3.00∘±3(0.0194∘)=3.00∘±0.058∘

مشاهده می‌شود که حتی در یک سنسور با کیفیت، بایاس بسیار ناچیز 0.05 deg/s در عرض تنها یک دقیقه خطای فاحشی معادل 3.0∘ در جهت‌گیری بدنه ایجاد می‌کند. این پدیده اثبات می‌کند که انتگرال‌گیری مدار باز ژیروسکوپ بدون لنگر انداختن به شتاب‌سنج (به عنوان مرجع استاتیک DC) در الگوریتم‌های تلفیق داده، محکوم به واگرایی است.


جمع‌بندی مهندسی و نکات کلیدی

  1. مبانی فیزیکی شیب‌سنجی: شیب زاویه انحراف نسبت به بردار گرانش زمین (g→) است. سنسورهای الکترولیتی و مکانیکی دقت‌های استاتیک فوق‌العاده‌ای (تا کسری از ثانیه قوسی) فراهم می‌کنند، اما پهنای باند فرکانسی پایینی داشته و برای کاربردهای دینامیک مناسب نیستند.
  2. برتری روش دومحوره بر تک‌محوره: شیب‌سنجی تک‌محوره با فرمول arcsin در زوایای فراتر از ±60∘ به دلیل صفر شدن حساسیت دیفرانسیلی (cosθ→0) دچار افت شدید دقت و واگرایی خطا می‌شود. شیب‌سنجی دومحوره با تابع atan2(Ax,Ay) حساسیت یکنواخت در کل گستره 360∘ تأمین کرده و مستقل از تغییرات دامنه شتاب ثقل عمل می‌کند.
  3. اصل هم‌ارزی و شتاب دینامیکی: شتاب‌سنج‌ها شتاب خطی حرکت، گریز از مرکز و ارتعاشات مکانیکی را با شتاب گرانش جمع می‌کنند. حتی یک شتاب خطی کوچک معادل 0.1g خطایی بیش از 5.7∘ در شیب‌سنجی ایجاد می‌کند. آزمون هنجار بردار گرانش (‖A→‖≈1g) شاخص تشخیصی مؤثری برای شناسایی شتاب‌های دینامیکی است.
  4. هم‌افزایی شتاب‌سنج و ژیروسکوپ در IMU: شتاب‌سنج مرجع پایدار فرکانس پایین (DC) است اما نویز دینامیکی دارد؛ ژیروسکوپ ردیاب فرکانس بالا و سریع است اما با انتگرال‌گیری دچار رانش نامحدود زمانی می‌شود. تلفیق این دو حسگر پایدارترین تخمین وضعیت را نتیجه می‌دهد.
  5. نقش مغناطیس‌سنج در سامانه‌های MARG: شتاب‌سنج نسبت به چرخش حول راستای بردار گرانش (زاویه سمت یا Yaw) کور است. افزودن مغناطیس‌سنج سه‌محوره به عنوان بردار مرجع دوم، تثبیت کامل سه‌بعدی وضعیت را امکان‌پذیر می‌سازد.
  6. تمایز علمی درجات آزادی با کانال‌های سنسوری: یک کالبد صلب در مکانیک نیوتنی دارای دقیقاً 6 درجه آزادی (6-DoF: سه انتقال و سه دوران) است. اصطلاحات بازاریابی مانند "9-DOF" در واقع سنسورهای 9 محوره برای مشاهده افزونه و دقیق‌تر همان 6 درجه آزادی مکانیکی هستند.

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

  • R01: Jacob Fraden, Handbook of Modern Sensors: Physics, Designs, and Applications, 5th Edition, Springer, 2016. (فصل‌های 8 و 9: اصول فیزیکی شتاب‌سنجی، شیب‌سنج‌های آونگی، ترازهای مایعی، و سنسورهای شیب الکترولیتی تفاضلی).
  • R20: Christopher J. Fisher, AN-1057: Using an Accelerometer for Inclination Sensing, Application Note, Analog Devices, Inc. (تحلیل ریاضی شیب‌سنجی تک‌محوره، دومحوره و سه‌محوره، تابع atan2، حساسیت دیفرانسیلی و خطای شتاب دینامیکی).
  • R19: TDK InvenSense, ICM-20689 High Performance 6-Axis MEMS MotionTracking Device Datasheet, Document DS-000143, Revision 1.1, March 2021. (معماری مجتمع شتاب‌سنج و ژیروسکوپ، ویژگی‌های فرکانسی، کالیبراسیون و هم‌ترازی).
  • R22: Oliver J. Woodman, An Introduction to Inertial Navigation, Technical Report UCAM-CL-TR-696, University of Cambridge, August 2007. (مبانی خطاهای اینرسی، رانش بایاس، گام‌زنی تصادفی زاویه ARW، و سینماتیک دوران کالبد صلب).

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

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

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