bertl.h

Committer:
DomiSukic
Date:
2016-03-07
Revision:
0:09cac0d76c5e

File content as of revision 0:09cac0d76c5e:

#include <mbed.h>
//Checkbit-Defines
#define CHECK_BIT(var,pos) ((var) & (1<<(pos))) //Checks if bits are set Input: Variable to chaeck adn the position of the bit to check
//LED-Defines
#define LED_OFF 0x00            // 0b0000 0000, All Leds are off
#define LED_FL_WHITE 0x01       // 0b0000 0001, BERTL FORWARD Left-Side WHITE-LED
#define LED_FL_YELLOW 0x02      // 0b0000 0010, BERTL FORWARD Left-Side YELLOW-LED
#define LED_FR_WHITE 0x04       // 0b0000 0100, BERTL FORWARD Right-Side WHITE-LED
#define LED_FR_YELLOW 0x08      // 0b0000 1000, BERTL FORWARD Right-Side YELLOW-LED
#define LED_BL_RED 0x10         // 0b0001 0000, BERTL BACKWARD Left-Side RED-LED
#define LED_BL_YELLOW 0x20      // 0b0010 0000, BERTL BACKWARD Left-Side YELLOW-LED
#define LED_BR_RED 0x40         // 0b0100 0000, BERTL BACKWARD Right-Side RED-LED
#define LED_BR_YELLOW 0x80      // 0b1000 0000, BERTL BACKWARD Right-Side YELLOW-LED
#define LED_ON 0xFF             // 0b1111 1111, All Leds are on
 
#define LED_R_YELLOW (LED_FR_YELLOW|LED_BR_YELLOW)          // 0b1000 1000, BERTL Right Side, YELLOW-LEDs are on
#define LED_L_YELLOW (LED_FL_YELLOW|LED_BL_YELLOW)          // 0b0010 0010, BERTL Left Side, YELLOW-LEDs are on
#define LED_F_WHITE (LED_FL_WHITE|LED_FR_WHITE)             // 0b0000 0101, BERTL Forward, WHITE-LEDs are on
#define LED_B_RED (LED_BL_RED|LED_BR_RED)                   // 0b0101 0000, BERTL Backward, RED LEDs are on
#define LED_B_ALL (LED_B_RED|LED_BL_YELLOW|LED_BR_YELLOW)   // 0b1111 0000, BERTL Backward, All LEDs are on
#define LED_F_ALL (LED_F_WHITE|LED_FL_YELLOW|LED_FR_YELLOW) // 0b0000 1111, BERTL Forward, All LEDs are on

// Define PC9555 Routines
#define PC9555_ADDR_W 0x40 //A2 = A1 = A0 = 0, WRITE-ADRESS
#define PC9555_ADDR_R 0x41 // READ-ADRESS, to set the Read-bit
#define PC9555_FREQUENCY 100000 // fI2C in Hz

// PC9555 Commands
#define PC9555_PORT0_IN (0)
#define PC9555_PORT1_IN (1)
#define PC9555_PORT0_OUT (2)
#define PC9555_PORT1_OUT (3)
#define PC9555_PORT0_INV (4)
#define PC9555_PORT1_INV (5)
#define PC9555_PORT0_DIRCONFIG (6)
#define PC9555_PORT1_DIRCONFIG (7)

// Define Motor Routines
#define ENGINE_LEFT_BACKWARD P1_0       //IN1, EP10, MG1A => MG1 engine-Pin 2, left_Reverse
#define ENGINE_LEFT_FORWARD P1_1        //IN2, EP11, MG1B => MG1 engine-Pin 1, left_Forward
#define ENGINE_ENABLE_LEFT P1_15        //EN1, P34, left_ENABLE
#define ENGINE_RIGHT_REVERSE P1_4       //IN4, EP13, MG2A => MG2 engine-Pin 2, right_Reverse
#define ENGINE_RIGHT_FORWARD P1_3       //IN3, EP14, MG2B => MG2 engine-Pin 1, right_Forward
#define ENGINE_ENABLE_RIGHT P0_21       //EN2, P36, right_ENABLE
#define MAX_PWM 255                     //Define the MAX Value of the PWM

// Motor Routines
void bertl_engine(int left, int right);
void bertl_engine_test();
 
// PC9555 routines
void bertl_PC9555_init();
void bertl_PC9555_leds(unsigned char leds);
unsigned char bertl_PC9555_switches();

//Checkbit Routines
 bool checkbitFront();
 bool checkbitBack();