RGB

Dependencies:   mbed

Fork of RGB-15 by Ladner-Praja

main.cpp

Committer:
Matthias_Praja
Date:
2016-01-08
Revision:
11:664f39cee220
Parent:
10:ef475b0762ae

File content as of revision 11:664f39cee220:

#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 = 1;
    online = 1;
    Motor_SENSOR=0;
    
    myrgb = 0x07;//7->aus
    LedBlue=0;
    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(~0x80);
    i2c.stop();
    
    while(1){
        myled=myline;
        // <-6
        // <-5
        // <-3
        }
}