florian schriebl / bertl14

Important changes to repositories hosted on mbed.com

Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.

To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.

It is also possible to export all your personal repositories from the account settings page.

Fork of bertl14 by Kevin Heinrich

bertl14.cpp@1:01bc0c86f111, 2016-01-25 (annotated)

Committer:
heinrich_kevin
Date:
Mon Jan 25 11:44:13 2016 +0000
Revision:
1:01bc0c86f111
Parent:
0:f40ab7184c3f
Child:
2:d9f2452ba88d
NEW VERSION;

Who changed what in which revision?

UserRevisionLine numberNew contents of line
heinrich_kevin 0:f40ab7184c3f 1 #include <mbed.h>
heinrich_kevin 0:f40ab7184c3f 2 #include "bertl14.h"
heinrich_kevin 1:01bc0c86f111 3 //*********************************************************************************
heinrich_kevin 1:01bc0c86f111 4 // Define Motor Routines
heinrich_kevin 0:f40ab7184c3f 5 DigitalOut engineLR(P1_0); //IN1, EP10, MG1A => MG1 engine-Pin 2, left_Reverse
heinrich_kevin 0:f40ab7184c3f 6 DigitalOut engineLF(P1_1); //IN2, EP11, MG1B => MG1 engine-Pin 1, left_Forward
heinrich_kevin 0:f40ab7184c3f 7 PwmOut engineLEN(p34); //EN1, P34, left_ENABLE
heinrich_kevin 0:f40ab7184c3f 8 DigitalOut engineRR(P1_4); //IN4, EP13, MG2A => MG2 engine-Pin 2, right_Reverse
heinrich_kevin 0:f40ab7184c3f 9 DigitalOut engineRF(P1_3); //IN3, EP14, MG2B => MG2 engine-Pin 1, right_Forward
heinrich_kevin 0:f40ab7184c3f 10 PwmOut engineREN(p36); //EN2, P36, right_ENABLE
heinrich_kevin 1:01bc0c86f111 11 //**********************************************************************************
heinrich_kevin 1:01bc0c86f111 12 // Define PC9555 Routines
heinrich_kevin 1:01bc0c86f111 13 I2C pc9555 (P0_5, P0_4);// SDA, SCL
heinrich_kevin 0:f40ab7184c3f 14
heinrich_kevin 1:01bc0c86f111 15 //**********************************************************************************
heinrich_kevin 1:01bc0c86f111 16 //Start PC9555 Routines
heinrich_kevin 1:01bc0c86f111 17 void bertl_PC9555_init()
heinrich_kevin 1:01bc0c86f111 18 {
heinrich_kevin 1:01bc0c86f111 19 char data[2];
heinrich_kevin 1:01bc0c86f111 20 // I2C-Initialisierung
heinrich_kevin 1:01bc0c86f111 21 pc9555.frequency(PC9555_FREQUENCY);
heinrich_kevin 1:01bc0c86f111 22 // Port 0 = Leds, Port 1 = Switches
heinrich_kevin 1:01bc0c86f111 23 // Adresse, R/W# = 0, Config PORT 0 (6) = 0x00(= Output), Stop
heinrich_kevin 1:01bc0c86f111 24 data[0] = PC9555_PORT0_DIRCONFIG;
heinrich_kevin 1:01bc0c86f111 25 data[1] = 0x00;
heinrich_kevin 1:01bc0c86f111 26 pc9555.write(PC9555_ADDR, data, 2);
heinrich_kevin 1:01bc0c86f111 27 // Adresse, R/W# = 0, Config PORT 1 (7) = 0xFF(= Input), Stop
heinrich_kevin 1:01bc0c86f111 28 data[0] = PC9555_PORT1_DIRCONFIG;
heinrich_kevin 1:01bc0c86f111 29 data[1] = 0xFF;
heinrich_kevin 1:01bc0c86f111 30 pc9555.write(PC9555_ADDR, data, 2);
heinrich_kevin 1:01bc0c86f111 31
heinrich_kevin 1:01bc0c86f111 32 }
heinrich_kevin 1:01bc0c86f111 33
heinrich_kevin 1:01bc0c86f111 34 void bertl_PC9555_leds(unsigned char leds)
heinrich_kevin 1:01bc0c86f111 35 {
heinrich_kevin 1:01bc0c86f111 36 char data[2]; //Two Bits for Transmitt via I2C
heinrich_kevin 1:01bc0c86f111 37 // Send leds to PORT0 of PC9555 via I2C:
heinrich_kevin 1:01bc0c86f111 38 // Start, Address, RW# = 0, CMD PC9555_PORT0_OUT, leds, STOP
heinrich_kevin 1:01bc0c86f111 39 data[0] = PC9555_PORT0_OUT;
heinrich_kevin 1:01bc0c86f111 40 data[1] = ~leds; //bitwise inversion since Hardware is switched on with 0 (inverse logic)
heinrich_kevin 1:01bc0c86f111 41 pc9555.write(PC9555_ADDR, data, 2);
heinrich_kevin 1:01bc0c86f111 42 }
heinrich_kevin 1:01bc0c86f111 43
heinrich_kevin 1:01bc0c86f111 44 unsigned char bertl_PC9555_switches()
heinrich_kevin 1:01bc0c86f111 45 {
heinrich_kevin 1:01bc0c86f111 46 ;
heinrich_kevin 1:01bc0c86f111 47 }
heinrich_kevin 1:01bc0c86f111 48 // END PC9555 Routines
heinrich_kevin 1:01bc0c86f111 49 //**********************************************************************************
heinrich_kevin 1:01bc0c86f111 50
heinrich_kevin 1:01bc0c86f111 51 // Begin Motor Routines
heinrich_kevin 0:f40ab7184c3f 52 void bertl_engine(int left, int right)
heinrich_kevin 0:f40ab7184c3f 53 {
heinrich_kevin 0:f40ab7184c3f 54 // If the left engines-value is greater than 0, the left engine turn FORWARD
heinrich_kevin 0:f40ab7184c3f 55 if(left > 0)
heinrich_kevin 0:f40ab7184c3f 56 {
heinrich_kevin 0:f40ab7184c3f 57 engineLF=1;
heinrich_kevin 0:f40ab7184c3f 58 engineLR=0;
heinrich_kevin 0:f40ab7184c3f 59 }
heinrich_kevin 0:f40ab7184c3f 60 // Or if the left engines-value is less than 0, the left engine turn REVERSE
heinrich_kevin 0:f40ab7184c3f 61 else if(left < 0)
heinrich_kevin 0:f40ab7184c3f 62 {
heinrich_kevin 0:f40ab7184c3f 63 engineLF=0;
heinrich_kevin 0:f40ab7184c3f 64 engineLR=1;
heinrich_kevin 0:f40ab7184c3f 65 left = left * (-1); // For PWM the Value have to be positive
heinrich_kevin 0:f40ab7184c3f 66 }
heinrich_kevin 0:f40ab7184c3f 67 // If the right engines-value is greater than 0, the right engine turn FORWARD
heinrich_kevin 0:f40ab7184c3f 68 if(right > 0)
heinrich_kevin 0:f40ab7184c3f 69 {
heinrich_kevin 0:f40ab7184c3f 70 engineRF=1;
heinrich_kevin 0:f40ab7184c3f 71 engineRR=0;
heinrich_kevin 0:f40ab7184c3f 72 }
heinrich_kevin 0:f40ab7184c3f 73 // Or if the right engines-value is less than 0, the right engine turn REVERSE
heinrich_kevin 0:f40ab7184c3f 74 else if(right < 0)
heinrich_kevin 0:f40ab7184c3f 75 {
heinrich_kevin 0:f40ab7184c3f 76 engineRF=0;
heinrich_kevin 0:f40ab7184c3f 77 engineRR=1;
heinrich_kevin 0:f40ab7184c3f 78 right = right * (-1); // For PWM the Value have to be positive
heinrich_kevin 0:f40ab7184c3f 79 }
heinrich_kevin 0:f40ab7184c3f 80 //pc.printf("left: %4d\r\n", left);
heinrich_kevin 0:f40ab7184c3f 81 //pc.printf("right: %4d\r\n", right);
heinrich_kevin 0:f40ab7184c3f 82 // Or if the right- or/and the left engines value equals 0, the ENABLE-Pin turn off (ENABLE Pin equals 0)
heinrich_kevin 0:f40ab7184c3f 83 engineLEN=(left/255.0); // PWM Value : 0 ... 1
heinrich_kevin 0:f40ab7184c3f 84 engineREN=(right/255.0); // PWM Value : 0 ... 1
heinrich_kevin 0:f40ab7184c3f 85 }
heinrich_kevin 0:f40ab7184c3f 86 //Begin Testing bertl-engines
heinrich_kevin 0:f40ab7184c3f 87 void bertl_engine_test()
heinrich_kevin 0:f40ab7184c3f 88 {
heinrich_kevin 0:f40ab7184c3f 89 bertl_engine(100, 0); //The left engine must turn FORWARD for 2 seconds
heinrich_kevin 0:f40ab7184c3f 90 wait(2);
heinrich_kevin 0:f40ab7184c3f 91 bertl_engine(0, 100); //The right engine must turn FORWARD for 2 seconds
heinrich_kevin 0:f40ab7184c3f 92 wait(2);
heinrich_kevin 0:f40ab7184c3f 93 bertl_engine(-100, 0); //The left engine must turn REVERSE for 2 seconds
heinrich_kevin 0:f40ab7184c3f 94 wait(2);
heinrich_kevin 0:f40ab7184c3f 95 bertl_engine(0, -100); //The right engine must turn REVERSE for 2 seconds
heinrich_kevin 0:f40ab7184c3f 96 wait(2);
heinrich_kevin 0:f40ab7184c3f 97 }
heinrich_kevin 1:01bc0c86f111 98 //End Testing bertl-engines
heinrich_kevin 1:01bc0c86f111 99 // END Motor Routines