Diff: CurrentRegulator/CurrentRegulator.cpp

Revision:

14:80ce59119d93

Parent:

13:a3fa0a31b114

Child:

15:ef00814e38e2

--- a/CurrentRegulator/CurrentRegulator.cpp	Sun May 22 03:47:40 2016 +0000
+++ b/CurrentRegulator/CurrentRegulator.cpp	Mon Oct 31 16:48:16 2016 +0000
@@ -29,6 +29,8 @@
     I_C = 0;
     I_Alpha = 0;
     I_Beta = 0;
+    IQ_Old = 0;
+    ID_Old = 0;
     count = 0;
     _L = L;
     _Kp = Kp;
@@ -38,8 +40,7 @@
     Int_Max = .9;
     DTC_Max = .97;
     //theta_elec = _PositionSensor->GetElecPosition();
-    //pc = new Serial(PA_2, PA_3);
-    //pc->baud(115200);
+
     
     }
 
@@ -95,7 +96,14 @@
 void CurrentRegulator::SampleCurrent(){
     _Inverter->GetCurrent(&I_A, &I_B, &I_C);
     Clarke(I_A, I_B, &I_Alpha, &I_Beta);
-    Park(I_Alpha, I_Beta, theta_elec, &I_D, &I_Q);
+    float ID_Sample, IQ_Sample;
+    //Park(I_Alpha, I_Beta, theta_elec, &I_D, &I_Q);
+    
+    Park(I_Alpha, I_Beta, theta_elec, &ID_Sample, &IQ_Sample);    
+    I_D = .5f*ID_Sample + .5f*ID_Old;
+    I_Q = .5f*IQ_Sample + .5f*IQ_Old;
+    ID_Old = I_D;
+    IQ_Old = I_Q;
     //count += 1;
     //if(count > 10000) {
     //    count=0;
@@ -134,7 +142,7 @@
     
     
 void CurrentRegulator::Commutate(){
-    //count += 1;
+    count += 1;
     //GPIOC->ODR = (1 << 4); //Toggle pin for debugging
     theta_elec = _PositionSensor->GetElecPosition();
     _PositionSensor->GetMechPosition();
@@ -143,13 +151,13 @@
     SetVoltage();   //Set inverter duty cycles
     //GPIOC->ODR = (0 << 4); //Toggle pin for debugging
 
-    /*
+    
     if (count==1000){
-        pc->printf("%f\n\r", _PositionSensor->GetMechPosition());
+        //printf("%f\n\r", V_A);
         count = 0;
         }
 
-    }
+    
     
-      */  
+      
       }