Diff: main.cpp

Revision:

0:cce97dfa8e6b

Child:

1:28cfac75543f

--- /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