کنترل PID با برد آردوینو توسط سنسور التراسونیک (SRF05)

مهفوم کامل PID با برد آردوینو

در این فیلم قصد داریم توسط برد آردوینو یک موتور را با استفاده از الگوریتم  PID کنترل کنیم. ابتدا برای این کار لازم است مقدمه ای در مورد کنترل PID بیان شود. برای این منظور به لینک مراجعه کنید.

پس از آشنایی مقدماتی با این نوع از کنترل به سراغ مثالی از این کنترل در برد آردوینو میرویم.

در این مثال با استفاده از یک عدد سنسور التراسونیک SRF 05 و یک موتور DC این کنترلر را پیاده سازی می کنیم به این صورت که تا زمانی که فاصله سنسور از جسم مقابل سنسور ۱۰۰ سانتی متر(۱متر) باشد موتور می ایستد هرچه فاصله بیشتر شود پاد ساعتگرد واگر فاصله کمتر شود ساعتگرد خواهد چرخید. به عبارت دیگر قصد داریم سرعت دوران و جهت دوران یک موتور دی سی را توسط برد آردوینو و سنسور التراسونیک SFR05 کنترل کنیم.

ابتدا توضیح کوتاهی در مورد سنسور التراسونیک میدهیم.
این سنسور ها دارنده یک فرستنده و گیرنده می باشد که یک موج صوتی فرستاده می شود و با محاسبه زمان بازگشت و سرعت صوت در هوا می توان فاصله را محاسبه کرد. دقت داشته باشید که فرستنده باید حداقل به مدت ۱۰ میکرو ثانیه روشن بوده تا فاصله زمانی مناسب را خروجی بدهد.

در شکل زیر نحوه اتصال سیم ها به  سنسور نمایش داده شده است.

Sfr05

حال به سراغ نحوه سیم کشی کامل برد می رویم:

همانطور که در شکل زیر مشاهده می شود سیم های سنسور التراسونیک بر اساس data sheet به آردوینو متصل شده است. همچنین موتور به دو عدد از خروجی های PWM برد  آردویینو متصل میشود تا بتوانیم دور موتور را کنترل کنیم.

Fritzing_PID

سپس به سراغ نرم افزار آردوینو میرویم تا کد نویسی را آغاز کنیم.

کد های این برنامه به تفصیل توضیح داده شده است.

در ابتدا به معرفی متغیر ها می پردازیم:

تهیه کنندگان: مهندس سید امیر اشرفی- مهندس سینا اصفهانی

شاید این مطالب را هم دوست داشته باشید

3 پاسخ

  1. محمد می‌گه:

    با سلام. اگر بخواهیم سرعت جرکت دو موتور که به درایور L298N متصل هستند را توسط دو سنسور التراسونیک که هر سنسور یکی از موتور ها را کنترل میکند با توجه به کم یا زیاد شدن فاصله مانع نسبت به سنسور ها کم یا زیاد کنیم از چه کدی استفاده میشود؟

  2. علی می‌گه:

    با سلام و عرض خسته نباشید اگر بخواهیم شدت نور ال ای دی رو با التروسونیک کنترل کنیم درواقع با کمتر شدن فاصله جسم ب سنسور التروسونیک شدت نور بیشتر و با زیاد شدن فاصله شدت نور کمتر خواستم برنامه نویسی این پروژه رو بفرستید با تشکر

    • محمود حسن پور دهنوی محمود حسن پور دهنوی می‌گه:

      سلام
      ساختار کد شبیه کد همین مقاله هست با این تفاوت که خروجی به جای اعمال به موتور باید به LED اعمال بشه
      با تشکر

پاسخ دهید

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

CLOSE
CLOSE