main.cpp
- Committer:
- demo
- Date:
- 2009-09-19
- Revision:
- 0:41f85a3f645d
File content as of revision 0:41f85a3f645d:
// Sumo Robot control via Bluetooth/Nokia Presenter
// Copyright (c) 2009 sford
// Released under the MIT License: http://mbed.org/license/mit
#include "mbed.h"
#include "Motor.h"
#include "NokiaPresenter.h"
Motor left(p23, p6, p5); // pwm, fwd, rev
Motor right(p24, p8, p7); // pwm, fwd, rev
BusOut leds(LED1, LED2, LED3, LED4);
int main() {
leds = 1;
NokiaPresenter nokia(p28, p27, p29); // tx, rx, rst
leds = 2;
while(1) {
switch(nokia.key()) {
case 0:
left.speed(0.0);
right.speed(0.0);
leds = 0;
break;
case 'U':
left.speed(1.0);
right.speed(1.0);
leds = 1 << 0 | 1 << 2;
break;
case 'D':
left.speed(-1.0);
right.speed(-1.0);
leds = 1 << 1 | 1 << 3;
break;
case 'L':
left.speed(-1.0);
right.speed(1.0);
leds = 1 << 1 | 1 << 2;
break;
case 'R':
left.speed(1.0);
right.speed(-1.0);
leds = 1 << 0 | 1 << 3;
break;
}
}
}