2016年11月9日 星期三

[無人機]電調測試與自動油門行程偵測


這幾天測試了好盈Flyfun

根據使用手冊上的內容,將電機一上電要做的初始化寫在Arduino裡

一開始很不順利,一直無法正確抓到油門行程

後來測試出來將電調調回原廠設定的方式,

再將PWM經過LVC245調整電壓為3.3V

整個就回春了,下面是初始化的影片



Ardunio code
========================================================

int potpin=0;
int PWM_pin=10;//use timer1
int Pot_Value=0;
int Throttle_Min = 500;
int Throttle_Max = 900;
//

void setup() {
// put your setup code here, to run once:
int fff = 3;  // 可以是 1~5
TCCR1B = TCCR1B & 0xF8 | fff;//3設定PWM頻率為 490 Hz
pinMode(PWM_pin,OUTPUT);
Serial.begin(9600);

//  //編程模式
//  Serial.print("Set ESC: Max Throttle! \n");//
//  analogWrite(PWM_pin,Throttle_Max/4);//
//  delay(10000);

//  //初始化電變
  Serial.print("Set ESC: Max Throttle! \n");//
  analogWrite(PWM_pin,Throttle_Max/4);//
  delay(3000);

  Serial.print("Set ESC: Min Throttle! \n");//
  analogWrite(PWM_pin,Throttle_Min/4);//
  delay(2000);

  Serial.print("Set ESC OK \n");//
}

void loop() {
  // put your main code here, to run repeatedly:
  Pot_Value=analogRead(potpin);
  Serial.println(Pot_Value);//一邊將數值往序列埠顯示
  if(Pot_Value < Throttle_Max && Pot_Value > Throttle_Min)
  {
    analogWrite(PWM_pin,Pot_Value/4);//對Digital腳位寫入PWM
    delay(10);
  }
 
}

沒有留言:

張貼留言

[Sensor]MPU92/65

MPU92/65是很久以前買的感測器 基本上有加速度計、陀螺儀、電子羅盤、溫度計 以下是該電子商城的介紹 https://www.factoryforward.com/product/gy-87-mpu-9265-3-axis-9-dof-attitude-gyro-magnet...