关于ARDUINO小车的问题,求高手解答-Arduino中文社区 - Powered by Discuz!

Arduino中文社区

 找回密码
 立即注册

QQ登录

只需一步,快速开始

查看: 3540|回复: 1

[已解决] 关于ARDUINO小车的问题,求高手解答

[复制链接]
发表于 2014-3-23 15:01 | 显示全部楼层 |阅读模式
网上找的代码。控制时1号电机只能反转不能正转,2好电机正常,不知原因


#include <Servo.h>
Servo servo1;
Servo servo2;
int E1 = 5;
int E2 = 6;
int M1_1 =2;
int M1_2 =3;
int M2_1 = 4;
int M2_2 = 7;
int LED = 13;
int buffer[3];
int Serial_flag;
void setup()
{
  pinMode(13,OUTPUT);
  servo1.attach(9);//定义舵机控制口
  servo2.attach(10);
  Serial.begin(9600);
}
void Stop(void)
{
  digitalWrite(E1,LOW);//程序可以控制两路舵机(9、10接口)+两路直流电机。
  digitalWrite(E2,LOW);
}
void advance(int x)
{
  analogWrite(E1,x);
  digitalWrite(M1_1,LOW);
  digitalWrite(M1_2,HIGH);
  analogWrite(E2,x);
  digitalWrite(M2_1,LOW);
  digitalWrite(M2_2,HIGH);
}
void back(int x)
{
  analogWrite(E1,x);
  digitalWrite(M1_1,HIGH);
  digitalWrite(M1_2,LOW);
  analogWrite(E2,x);
  digitalWrite(M2_1,HIGH);
  digitalWrite(M2_2,LOW);
}
void left(int x)
{
  analogWrite(E1,x);
  digitalWrite(M1_1,LOW);
  digitalWrite(M1_2,HIGH);
  analogWrite(E2,x);
  digitalWrite(M2_1,HIGH);
  digitalWrite(M2_2,LOW);
}
void right(int x)
{
  analogWrite(E1,x);
  digitalWrite(M1_1,HIGH);
  digitalWrite(M1_2,LOW);
  analogWrite(E2,x);
  digitalWrite(M2_1,LOW);
  digitalWrite(M2_2,HIGH);
}
void Communication_Decode()
{
  if(buffer[0]==0x00)
  {
    switch(buffer[1])
    {
      case 0x01:advance(150);return;
      case 0x02:back(150);return;
      case 0x03:right(150);return;
      case 0x04:left(150);return;
      case 0x00:Stop(); return;
    }
  }
  else if(buffer[0]==0x01)
  {
    if(buffer[2]>180)return;
    switch(buffer[1])
    {
      case 0x01:servo1.write(buffer[2]);return;
      case 0x02:servo2.write(buffer[2]);return;
      default:return;
    }
  }
}
void loop()
{
  int temp_char;
  
  int date_index=0;
  
  while(1)
  {
    temp_char = Serial.read();
    if(temp_char!=-1)
    {
      
      if(Serial_flag==0)
      {
        if(temp_char==0xff)
        {
          Serial_flag = 1;
        }
      }
      else
      {
        if(temp_char==0xff)
        {
          Serial_flag = 0;
          if(date_index==3)
          {
            Communication_Decode();
          }
          date_index = 0;
        }
        else
        {
          buffer[date_index]=temp_char;
          Serial.println(buffer[date_index],HEX);
          date_index++;
        }
      }
    }
  }
}

 楼主| 发表于 2014-3-24 12:06 | 显示全部楼层
此帖仅作者可见
您需要登录后才可以回帖 登录 | 立即注册

本版积分规则

小黑屋|Archiver|手机版|Arduino中文社区

GMT+8, 2024-12-4 17:19 , Processed in 0.070349 second(s), 14 queries .

Powered by Discuz! X3.4

Copyright © 2001-2021, Tencent Cloud.

快速回复 返回顶部 返回列表