Robofun 機器人論壇

 找回密碼
 申請會員
搜索
熱搜: 活動 交友 discuz
查看: 5131|回復: 0

meetAndroid 控制伺服馬達問題

[複製鏈接]
發表於 2013-4-26 11:47:39 | 顯示全部樓層 |閱讀模式
#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上板子後,馬達不會動 (先測試一顆馬達)

目前伺服馬達供電問題的可能性已經排除了

懇請各位大大指點有什麼需要修改的?
您需要登錄後才可以回帖 登錄 | 申請會員

本版積分規則

小黑屋|手機版|Archiver|機器人論壇 from 2005.07

GMT+8, 2024-3-29 06:08 , Processed in 0.185756 second(s), 7 queries , Apc On.

Powered by Discuz! X3.2

© 2001-2013 Comsenz Inc.

快速回復 返回頂部 返回列表