[LinkIt One教學] 雙馬達機器人

使用 LinkIt One 來進行各種 I/O 之後,要做一台機器人也是一定要的。只要使用 L293D 這樣的馬達控制晶片就可以控制直流馬達。先來看影片。偷懶使用 Motoduino 來當作馬達控制板,本程式無法調整馬達速度。

CAVEDU LinkIt One 系列文章

任何雙馬達車身都可以喔。行動電源是對 LinkIt One 供電,電池則是對馬達供電

10815893_889158677763902_535136444_n 10815734_889158541097249_2047084033_n

從上方看下去

10841307_889159007763869_1680010118_n

程式碼如下:

void setup() {

// put your setup code here, to run once:
pinMode(2, OUTPUT);
pinMode(3, OUTPUT);
pinMode(4, OUTPUT);
}

void loop() {
// put your main code here, to run repeatedly:
forward();
delay(500);
stopped();
delay(500);
back();
delay(500);
stopped();
delay(500);
left();
delay(500);
stopped();
delay(500);
right();
delay(500);
stopped();
delay(500);
}

void forward()
{
digitalWrite( 2, HIGH);
digitalWrite( 3, LOW);
digitalWrite( 4, LOW);
}

void back()
{
digitalWrite( 2, LOW);
digitalWrite( 3, LOW);
digitalWrite( 4, LOW);
}

void left()
{
digitalWrite( 2, HIGH);
digitalWrite( 3, LOW);
digitalWrite( 4, HIGH);
}

void right()
{
digitalWrite( 2, HIGH);
digitalWrite( 3, HIGH);
digitalWrite( 4, LOW);
}

void stopped()
{
digitalWrite( 2, HIGH);
digitalWrite( 3, HIGH);
digitalWrite( 4, HIGH);
}

發佈留言

發佈留言必須填寫的電子郵件地址不會公開。 必填欄位標示為 *