Library for driving a 3-phase brushless DC motor.

Dependents:   BLDC_mainProgram STMF302R8_MotorDrive HelloWorld_IHM07M1

BLDCmotorDriver

Introduction

This library is still being developed.

This is a Wiki page about BLDCmotorDriver library developed by TVZ Mechatronics Team. The library is part of our project of creating an e-bike which is supposed to drive/run a 3-phase brushless DC motor with Hall sensors.

We are testing our library on NXP mbed LPC1768 platform and driver DRV8301 from Texas Instruments to run our testing BLDC motor. Next step of our project is creating a standalone library for DRV8301.

Hall sensors

In our BLDC motors there are three Hall sensors located 120 degrees from one another, they are identified as InterruptIn/DigitalIn on mbed and they send zeros and ones on TeraTerm with we locate in which sector

Na našim testnim BLDC motorima postoje 3 halova senzora, koji su udaljeni za 120 stupnjeva jedan od drugoga te inicijaliziranjem svakog pojedinog kao InterruptIn/DigitalIn na pinovima mbeda preko terminala na računalu (TeraTerm) dobivamo prikaz binarnih nula i jedinica koji se slažu sa trobitnim gray-evim kodom, s time da smo kombinacije 000 i 111 definirali kao fault vrijednosti. Pošto se slučajevi kada su sva tri hallova senzora upaljena ili ugašena ne mogu dogoditi tj. ne bi se smijeli dogoditi, ukoliko je došlo do takve situacije dogodio se kvar na hallovim senzorima te bi motor trebao prijeći u mod rada bez hallovih senzora.

With that we got six combinations, which we use to determine six sectors:

  • 001 - Sector 1
  • 011 - Sector 2
  • 010 - Sector 3
  • 110 - Sector 4
  • 100 - Sector 5
  • 101 - Sector 6

Nakon toga odredili smo za sve tri faze stanja mosfeta..

/media/uploads/dfraj/3-bit_gray_code_ring.jpg

Components

/media/uploads/dfraj/kotac.jpg

BLDCmotorDriver.cpp

Committer:
mslovic
Date:
2015-05-22
Revision:
0:5602fba2a7f7
Child:
1:786897114846
Child:
2:7aae78b85e1d

File content as of revision 0:5602fba2a7f7:

#include "BLDCmotorDriver.h"

BLDCmotorDriver::BLDCmotorDriver(PinName gh_a, PinName gl_a, PinName gh_b, PinName gl_b, PinName gh_c, PinName gl_c, PinName h1, PinName h2, PinName h3, PinName led1) : GH_A(gh_a), GL_A(gl_a), GH_B(gh_b), GL_B(gl_b), GH_C(gh_c), GL_C(gl_c), H1(h1), H2(h2), H3(h3), Led1(led1) {
    sampleTime = 1e-3;
    switchingPeriod = 1.0 / 20e3;
    dutyCycle = tempDutyCycle = 0;
    GH_A.period(switchingPeriod); // applies to all PwmOut instances
    rl.setLimits(0.1, -0.1, 0, sampleTime); // initial 10 second ramp
}
void BLDCmotorDriver::configure(float sampleTime, float switchingFrequency, float rampUpSlope, float rampDownSlope) {
    if (sampleTime < 1e-6)
        sampleTime = 1e-3;
    if (switchingFrequency < 100)
        switchingFrequency = 20e3;
    if (rampUpSlope < 0 || rampUpSlope > 1)
        rampUpSlope = 0.1;
    if (rampDownSlope > 0 || rampDownSlope < -1)
        rampDownSlope = -0.1;
    this->sampleTime = sampleTime;
    switchingPeriod = 1.0 / switchingFrequency;
    rl.setLimits(rampUpSlope, rampDownSlope, 0, sampleTime);
}
int BLDCmotorDriver::HallRead(){           // hall 120°
  
    if(H1.read()== 1 && H2.read()== 0 && H3.read()== 0)
            sektor = 1; 
    else if(H1.read()== 1 && H2.read()== 1 && H3.read()== 0)
            sektor = 2;         
    else if(H1.read()== 0 && H2.read()== 1 && H3.read()== 0)
            sektor = 3;  
    else if(H1.read()== 0 && H2.read()== 1 && H3.read()== 1)
            sektor = 4;  
    else if(H1.read()== 0 && H2.read()== 0 && H3.read()== 1)
            sektor = 5;
    else if(H1.read()== 1 && H2.read()== 0 && H3.read()== 1)
            sektor = 6;             
    else 
       Led1 = 1; 
   
    return sektor;              
}
void BLDCmotorDriver::komutacijaBLDC() {
    dutyCycle = rl.out(tempDutyCycle);
    sektor = HallRead();
    if (dutyCycle > 0) {
        if (sektor > 6) sektor = 1;
        sektor++;        
        switch(sektor) {           
            case 1:               //100      
                GH_A = dutyCycle;
                GL_A = 0;
                GH_B = 0;
                GL_B = 0;
                GH_C = 0;
                GL_C = 1; 
                break;
           case 2:                //110
                GH_A = dutyCycle;
                GL_A = 0;
                GH_B = 0;
                GL_B = 1;
                GH_C = 0;
                GL_C = 0;
                break;
           case 3:                //010
                GH_A = 0;
                GL_A = 0;
                GH_B = 0;
                GL_B = 1;
                GH_C = dutyCycle;
                GL_C = 0; 
                break;
            case 4:               //011
                GH_A = 0;
                GL_A = 1;
                GH_B = 0;
                GL_B = 0;
                GH_C = dutyCycle;
                GL_C = 0;
                break;
            case 5:               //001
                GH_A = 0;
                GL_A = 1;
                GH_B = dutyCycle;
                GL_B = 0;
                GH_C = 0;
                GL_C = 0;
                break;    
            case 6:               //101
                GH_A = 0;
                GL_A = 0;
                GH_B = dutyCycle;
                GL_B = 0;
                GH_C = 0;
                GL_C = 1;
                break;
        }
    } else if (dutyCycle < 0) { // 
        if (sektor < 1) sektor = 6;
        sektor--;
        switch(sektor) {
            case 1:               //100      
                GH_A = dutyCycle;
                GL_A = 0;
                GH_B = 0;
                GL_B = 0;
                GH_C = 0;
                GL_C = 1; 
                break;
           case 2:                //110
                GH_A = dutyCycle;
                GL_A = 0;
                GH_B = 0;
                GL_B = 1;
                GH_C = 0;
                GL_C = 0;
                break;
           case 3:                //010
                GH_A = 0;
                GL_A = 0;
                GH_B = 0;
                GL_B = 1;
                GH_C = dutyCycle;
                GL_C = 0; 
                break;
            case 4:               //011
                GH_A = 0;
                GL_A = 1;
                GH_B = 0;
                GL_B = 0;
                GH_C = dutyCycle;
                GL_C = 0;
                break;
            case 5:               //001
                GH_A = 0;
                GL_A = 1;
                GH_B = dutyCycle;
                GL_B = 0;
                GH_C = 0;
                GL_C = 0;
                break;    
            case 6:               //101
                GH_A = 0;
                GL_A = 0;
                GH_B = dutyCycle;
                GL_B = 0;
                GH_C = 0;
                GL_C = 1;
                break;
                }                
        }else {
        coast();
    }
}
void BLDCmotorDriver::setDutyCycle(float dc) {
    if (dc >= -1 && dc <= 1) {
        ticker.attach(this, &BLDCmotorDriver::komutacijaBLDC, sampleTime);
        tempDutyCycle = dc;
    } else {
        coast();
    }
}
void BLDCmotorDriver::coast() {
    GH_A = 0;
    GL_A = 0;
    GH_B = 0;
    GL_B = 0;
    GH_C = 0;
    GL_C = 0;
    dutyCycle = tempDutyCycle = 0;
    rl.reset();
    ticker.detach();
}
float BLDCmotorDriver::getDutyCycle() {
    return dutyCycle;
}