Revision 0:d8dab3dae6f2, committed 2015-08-20

Comitter:

dfraj

Date:

Thu Aug 20 14:58:23 2015 +0000

Commit message:

Library for current regulation of BLDC motor.

Changed in this revision

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/CurrentRegulation.cpp	Thu Aug 20 14:58:23 2015 +0000
@@ -0,0 +1,84 @@
+#include "CurrentRegulation.h"
+
+CurrentRegulation::CurrentRegulation(PinName pI_A, PinName pI_B, PinName pI_C, PinName pI_TOTAL):I_A(pI_A), I_B(pI_B), I_C(pI_C), I_TOTAL(pI_TOTAL){
+    setValues(1e-3, 1e3, 40e3, 20e3, 3.3);
+    measure1.attach_us(this, &CurrentRegulation::calculateCurrentA, 500);
+    measure2.attach_us(this, &CurrentRegulation::calculateTotalCurrent, 500);
+}
+
+CurrentRegulation::CurrentRegulation(PinName pI_A, PinName pI_B, PinName pI_C, PinName pI_TOTAL, double R_sh, double R_1, double R_fs, double R_ft, double V_ref):I_A(pI_A), I_B(pI_B), I_C(pI_C), I_TOTAL(pI_TOTAL){
+    setValues(R_sh, R_1, R_fs, R_ft, V_ref);
+    measure1.attach_us(this, &CurrentRegulation::calculateCurrentA, 500);
+    measure2.attach_us(this, &CurrentRegulation::calculateTotalCurrent, 500);
+}
+
+void CurrentRegulation::setValues(double R_sh, double R_1, double R_fs, double R_ft, double V_ref){
+    this->R_sh = R_sh;
+    this->R_1 = R_1;
+    this->R_fs = R_fs;
+    this->R_ft = R_ft;
+    this->V_ref = V_ref;    
+}
+
+void CurrentRegulation::calculateCurrentA(){
+    double V_outa = (V_ref - (V_ref/2))/(1 - 0) * I_A.read() + (V_ref/2);
+    this->I_A_ = (R_1 * V_outa)/(R_sh * R_fs) - (R_1 * (V_ref/2))/(R_sh * R_fs);
+}
+
+void CurrentRegulation::calculateCurrentB(){
+    double V_outb = (V_ref - (V_ref/2))/(1 - 0) * I_B.read() + (V_ref/2);
+    this->I_B_ = (R_1 * V_outb)/(R_sh * R_fs) - (R_1 * (V_ref/2))/(R_sh * R_fs);
+}
+
+void CurrentRegulation::calculateCurrentC(){
+    double V_outc = (V_ref - (V_ref/2))/(1 - 0) * I_C.read() + (V_ref/2);
+    this->I_C_ = (R_1 * V_outc)/(R_sh * R_fs) - (R_1 * (V_ref/2))/(R_sh * R_fs);
+}
+
+void CurrentRegulation::calculateTotalCurrent(){
+    double V_outt = (V_ref - (V_ref/2))/(1 - 0)*I_TOTAL.read()+(V_ref/2);
+    this->I_TOTAL_ = (R_1 * V_outt)/(R_sh * R_fs) - (R_1 * (V_ref/2))/(R_sh * R_fs);
+}
+
+double showResult(){
+    double I_Ar = this->I_A_;
+    return I_Ar;
+}
+
+double CurrentRegulation::calculateKr(){
+    T_pv = 1e-4;
+    T_ch = 25e-6;
+    zeta = 1.2;
+    K_ch = 50.0;
+    K_pv = 1.0;
+    T_I = 1.428e-3;
+    K_a = 4.76;
+    T_suma = (T_pv + T_ch);
+    K_oR = 1/(4 * (zeta * zeta) * T_suma);
+    return K_R = (K_oR * T_I)/(K_a * K_ch * K_pv);
+}
+
+/*
+void CurrentMeasurement::phaseCurrent(int currentSector){
+    switch(currentSector){  
+           case 0:                
+                measureCurrentC();
+                break;
+           case 1:            
+                measureCurrentC(); 
+                break;
+           case 2:   
+                measureCurrentA();   
+                break;
+            case 3:             
+                measureCurrentA(); 
+                break;
+            case 4:              
+                measureCurrentB();  
+                break;    
+            case 5:              
+                measureCurrentB();  
+                break;
+        }
+}
+*/
\ No newline at end of file

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/CurrentRegulation.h	Thu Aug 20 14:58:23 2015 +0000
@@ -0,0 +1,23 @@
+#ifndef CURRENTREGULATION_H
+#define CURRENTREGULATION_H
+
+#include "mbed.h"
+
+class CurrentRegulation{
+    public:
+        CurrentRegulation(PinName I_A, PinName I_B, PinName I_C, PinName I_TOTAL);
+        CurrentRegulation(PinName I_A, PinName I_B, PinName I_C, PinName I_TOTAL, double R_sh, double R_1, double R_fs, double R_ft, double V_ref);
+        void setValues(double R_sh, double R_1, double R_fs, double R_ft, double V_ref);
+        void calculateCurrentA();
+        void calculateCurrentB();
+        void calculateCurrentC();
+        void calculateTotalCurrent();
+        double calculateKr();  
+        double showResult();      
+    private:
+        AnalogIn I_A, I_B, I_C, I_TOTAL;
+        double R_sh, R_1, R_fs, R_ft, V_ref, I_A_, I_B_, I_C_, I_TOTAL_, zeta, T_suma, T_ch, T_pv, T_I, K_ch, K_R, K_pv, K_a, K_oR;
+        Ticker measure1, measure2;
+    };
+
+#endif
\ No newline at end of file