Prüfung
Fork of bertl14 by
bertl14.h
- Committer:
- heinrich_kevin
- Date:
- 2016-04-04
- Revision:
- 5:066936e2c097
- Parent:
- 3:4326e2654adb
File content as of revision 5:066936e2c097:
#include <mbed.h> //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_YELLOW (LED_L_YELLOW|LED_R_YELLOW) // 0b1010 1010, BERTL, all 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 //-------------------------------------- // Switches: // Switch TA1: DEZ = 1 #define TA_FM 0x01 // front middle switch // Switch TA2: DEZ = 2 #define TA_BM 0x02 // back middle switch // Switch TA3: DEZ = 4 #define TA_FL 0x04 // front left switch // Switch TA4: DEZ = 8 #define TA_FR 0x08 // front right switch // Switch TA5: DEZ = 16 #define TA_BL 0x10 // back left switch // Switch TA6: DEZ = 32 #define TA_BR 0x20 // back right switch // Switch TA7: DEZ = 64 #define TA_BF_L 0x40 // bottom front left switch // Switch TA8: DEZ = 128 #define TA_BF_R 0x80 // bottom front right switch #define TA_F (TA_FL|TA_FM|TA_FR) // All front switches #define TA_B (TA_BL|TA_BM|TA_BR) // All back switches //-------------------------------------- // 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();