|
#include<MeetAndroid.h>
#include<Servo.h>
MeetAndroid meetAndroid;
Servo servoX,servoY;
int posX=0;
int posY=0;
void setup()
{
Serial.begin(9600);
servoX.attach(5);
servoY.attach(6);
meetAndroid.registerFunction(phoneorient,'A'); //讀取手機加速規資料寫入伺服馬達
}
void loop()
{
meetAndroid.receive();
}
void phoneorient(byte flag, byte numOfValues)
{
int Steer,Delta;
int values[]={0,0,0};
meetAndroid.getIntValues(values);
Steer = values[0];
Delta = values[1];
controlX(Steer);
Serial.print(Steer);
Serial.print("\t");
Serial.print(Delta);
Serial.println();
}
void controlX(int Steer)
{
if(Steer >= -5)
{
servoX.write(179);
delay(15);
}
else if(Steer >= -4)
{
servoX.write(162);
delay(15);
}
else if(Steer >= -3)
{
servoX.write(144);
delay(15);
}
else if(Steer >= -2)
{
servoX.write(126);
delay(15);
}
else if(Steer >= -1)
{
servoX.write(108);
delay(15);
}
else if(Steer >= 0)
{
servoX.write(90);
delay(15);
}
else if(Steer >= 1)
{
servoX.write(72);
delay(15);
}
else if(Steer >= 2)
{
servoX.write(54);
delay(15);
}
else if(Steer >= 3)
{
servoX.write(36);
delay(15);
}
else if(Steer >= 4)
{
servoX.write(18);
delay(15);
}
else
{
servoX.write(0);
delay(15);
}
}
現在的問題是,程式LOAD上板子後,馬達不會動 (先測試一顆馬達)
目前伺服馬達供電問題的可能性已經排除了
懇請各位大大指點有什麼需要修改的? |
|