Duncan Haldane / mbed_BLDC_driver_KL25Z

Initial commit of motor driver firmware

Dependencies:   mbed-src

Fork of mbed_AS5047P_driver by Duncan Haldane

main.cpp

Committer:
dhaldane
Date:
2016-09-28
Revision:
1:d68c51a0a706
Parent:
0:00c56a9c6dee

File content as of revision 1:d68c51a0a706:

#include "mbed.h"
#include "enc.h"

//Ticker RTI;
Serial imProc(PTD7,PTD6);
DigitalOut led_1(PTC2);
DigitalOut led_2(PTC3);
DigitalOut led_3(PTA18);
enc motPos(PTC6,PTC7,PTC5,PTC4);
PwmOut EN(PTA4);
DigitalOut DR(PTA2);
DigitalOut BRAKE(PTA1);
AnalogIn motCurrent(PTB0);
AnalogIn temp(PTE30);


void get_state(){
    motPos.update_pos();
}

int main() {  
        EN.period_us(50);
    EN.write(0.9f);
    DR.write(0);
    BRAKE.write(1);
      motPos.set_offset(2160);
      led_1 = 1;
//    RTI.attach(&get_state, 0.01f);
    while(1) {
        
        led_2 = 1;
        led_3 = 0;
        wait(0.5);
        led_2 = 0;
        led_3 = 1;
        wait(0.5);
    }
}