Matthias Praja
/
RGB-15
RGB
Fork of RGB-15 by
Diff: main.cpp
- Revision:
- 0:cce97dfa8e6b
- Child:
- 1:28cfac75543f
diff -r 000000000000 -r cce97dfa8e6b main.cpp --- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/main.cpp Tue Jul 07 20:26:04 2015 +0000 @@ -0,0 +1,74 @@ +#include "mbed.h" + +I2C i2c(p28, p27); +BusOut myled(LED1,LED2,LED3,LED4); +BusOut myrgb(P1_23,P1_25,P1_24); +DigitalOut LedBlue(P1_28); +BusIn myline(p18,p16,p19,p17); +DigitalIn linecenter(p20); +DigitalOut online(P1_6); +DigitalOut MotorL_EN(P1_15); +DigitalOut MotorL_FORWARD(P1_1); +DigitalOut MotorL_REVERSE(P1_0); +DigitalOut MotorR_EN(P0_21); +DigitalOut MotorR_FORWARD(P1_3); +DigitalOut MotorR_REVERSE(P1_4); +DigitalOut Motor_SENSOR(P1_7); +DigitalOut enable(P1_2); +PwmOut mg1(P1_15); +PwmOut mg2(P0_21); +DigitalIn SensorL(P1_12); +DigitalIn SensorR(P1_13); +int data; +int main() +{ + enable = 0; + online = 0; + Motor_SENSOR=0; + + myrgb = 0x07;//7->aus + LedBlue=1; + myled = 0x00; + + MotorL_EN = 0; + MotorL_FORWARD = 0; + MotorL_REVERSE = 0; + MotorR_EN = 0; + MotorR_FORWARD = 0; + MotorR_REVERSE = 0; + mg1=0.5; + mg2=0.5; + + i2c.start(); + i2c.write(0x40); + i2c.write(0x06); + i2c.write(0x00); + i2c.stop(); + + i2c.start(); + i2c.write(0x40); + i2c.write(0x02); + i2c.write(~0x00); + i2c.stop(); + + while(1){ + // Einlesen der Taster und speichern unter data + i2c.start(); + i2c.write(0x40); + i2c.write(0x01); + i2c.start(); + i2c.write(0x41); + data = i2c.read(0); + i2c.stop(); + + //01->forneMitte + //02->hintenMitte + //04->forneLinks + //08->forneRects + //10->hintenLinks + //20->hintenRechts + //40->Rechts + //80->Links + + } +} \ No newline at end of file