LPC824 trial

LPC824_check_motor.c

#include "mbed.h"

AnalogIn sensor[] = {dp19, dp20, dp21};

BusOut mdA(dp7, dp6);
BusOut mdB(dp9, dp8);

Serial pc(USBTX, USBRX);

int motorTest(int code){
    switch(code){
        case 1:
            mdA = 0b10;
            mdB = 0b00;
            break;
        case 2:
            mdA = 0b00;
            mdB = 0b10;
            break;
        case 3:
            mdA = 0b01;
            mdB = 0b00;
            break;
        case 4:
            mdA = 0b00;
            mdB = 0b01;
            break;
        case 5:
            mdA = 0b10;
            mdB = 0b10;
            break;
        case 6:
            mdA = 0b01;
            mdB = 0b01;
            break;
        default:
            mdA = 0b11;
            mdB = 0b11;
            code = 0;
            break;
    }
    return code++;
}

int main()
{
    int code = 0;
    
    mdA = 0b11;
    mdB = 0b11;
    
    while(1) {
        pc.printf("Test code: %d\r\n", code);
        code = motorTest(code);
        
        wait(1.0);
    }
}