מייקינג : שליטה על מנוע סרוו על פי לחץ ברומטרי

יום שלישי, 23 במאי 2017

שליטה על מנוע סרוו על פי לחץ ברומטרי

לשלוט על מנוע סרוו על פי לחץ ברומטרי זה די קל. האתגר היה ליצור קוד שרק בסדר פעולות מסוים ישלוט בארדואינו. כדי להסביר טוב יותר, נתחיל מהתחלה...

המשימה שקיבלו התלמידים היתה לתכנן מערכת על בסיס ארדואינו שתפתח בלון של חללית זעירה תוך כדי נפילתה לקרקע. המשימה היא לפתוח את הבלון בגובה מסוים מעל פני הים (נניח בגובה של 3 ק"מ) אולם מהצד השני, לפתוח את הבלון רק בירידה ולא בעליה כלפי מעלה...

התלמידים תכננו שהארדואינו "יחפש" את הערך של 3000 מ', אח"כ יחפש את הערך של 7000 מ' ולבסוף שוב את הערך של 3000 מ' ורק אז יפתח את המצנח. כמובן שאין מניעה במחינת התכנון הזה שהארדואינו ימדוד אפילו ערכים של 30,000 מ' אלא שיש מעין "טריגרים" שרק בסדר מסוים יפעילו את מנוע הסרוו שיפתח את המצנח.

בעזרתו האדיבה (מאד מאד) של שמוליק הצלחנו להשלים את המשימה. שמוליק לימד אותנו להשתמש בדגלים, flags, שהם בעצם סוג של סימניות שרק לאחר שהארדואינו "הרים דגל" מסוים הוא ממשיך לחפש את הדגל הבא וכך הלאה..

בסיום העבודה, הגענו לקוד הזה:

#include <Wire.h>
#include <Adafruit_Sensor.h>
#include <Adafruit_BMP085_U.h>
#include <LiquidCrystal.h>   
#include <Servo.h>
Servo ServoMotor;

Adafruit_BMP085_Unified bmp = Adafruit_BMP085_Unified(10085);

LiquidCrystal lcd(12, 11, 5, 4, 3, 2);

int distance;
int maxDistance=0;
int upMinimumDistance=900;
int servoDistance=900;
int planedPicDistance=850;

int upMinimumDistanceFlag=0;
int servoDistanceFlag=0;
int planedPicDistanceFlag=0;

void setup() 
{
ServoMotor.attach(9); 
ServoMotor.write(180); 
pinMode(13, OUTPUT);  
digitalWrite(13, LOW);

Serial.begin(9600); 
Serial.println("Pressure Sensor Test"); Serial.println("");
lcd.begin(16, 2);

if(!bmp.begin())  {
Serial.print("Ooops, no BMP085 detected ... Check your wiring or I2C ADDR!");
while(1);
}
}

void loop() 
{
sensors_event_t event;
bmp.getEvent(&event);
 
if (event.pressure)  {
Serial.print("Pressure: "); Serial.print(event.pressure); Serial.println(" hPa");
lcd.clear();
lcd.setCursor(0, 0);
lcd.print("Pressure: ");
lcd.setCursor(3, 1);
lcd.print(event.pressure);
}

else  {
Serial.println("Sensor error");
}

if (event.pressure > maxDistance)
maxDistance= event.pressure;

if (upMinimumDistanceFlag == 0 && event.pressure < upMinimumDistance ){
    upMinimumDistanceFlag = 1;  
    Serial.println("passed minimum - going up");
  }

if (planedPicDistanceFlag == 0 && event.pressure < planedPicDistance){
  planedPicDistanceFlag = 1; 
  Serial.println("passed planed pic - going up");
 }

if (planedPicDistanceFlag == 1 && event.pressure > maxDistance){
  planedPicDistanceFlag = 2; 
  Serial.println("passed max pic - going down");
 }
 
if (planedPicDistanceFlag > 0 && event.pressure > servoDistance){
    servoDistanceFlag = 1; 
    Serial.println("can open servo - going down");
  }

if (servoDistanceFlag == 1){
      servoDistanceFlag=2; 
      digitalWrite(13, HIGH);
      Serial.println("sero opened");
      ServoMotor.write(0); 
    }

delay(1000);
}

התרשים מבוסס על עבודות שעשינו בעבר אבל כאן נוספה נורת ביקורת (שאמורה לפעול רק כאשר מנוע הסרוו מופעל) ובנוסף נוסף כאן מנוע הסרוו עצמו.

כמובן שבשיגור החללית לא יהיה צורך במסך וחצי מהבלגן שיש כאן יחסך אבל כרגע לצורך הניסוי - אנו רוצים לדעת מה המצב בדיוק של הלחץ האטמוספרי ולוודא שהארדואינו עובד כמו שציפינו.

אז מה אתם אומרים? עובד או לא?

מצרף לכם סרטון וידאו לצפיה:

אין תגובות:

הוסף רשומת תגובה

הערות? הארות? יש לך משהו חשוב לספר לכולם? שאלות?

נשמח לשמוע!

(התגובה תפורסם בהקדם בכפוף לאישור מערכת מייקינג)

דפים

יום שלישי, 23 במאי 2017

שליטה על מנוע סרוו על פי לחץ ברומטרי

אין תגובות:

הוסף רשומת תגובה

קורס ארדואינו

קורס מיקרו:ביט