Correction of position of subroutines.

[fpga/rpi-motor-control.git] / pmsm-control / test_sw / main_pmsm.c

diff --git a/pmsm-control/test_sw/main_pmsm.c b/pmsm-control/test_sw/main_pmsm.c
index 50e32e19ce6e4f0e2d418ac99930f3bed7fab087..da278cc00301873121087a9b2ec648e36386b7b5 100644 (file)
--- a/pmsm-control/test_sw/main_pmsm.c
+++ b/pmsm-control/test_sw/main_pmsm.c
@@ -24,8 +24,6 @@
 #include "pmsm_state.h"
 #include "cmd_proc.h"
 
-#define PRUM_PROUD     2061
-#define PRUM_SOUC      6183
 #define MAX_DUTY       128
 #define PID_P          0.1
 
@@ -89,18 +87,7 @@ void substractOffset(struct rpi_in* data, struct rpi_in* offset){
        data->pozice-=offset->pozice;
        return;
 }
-/*
- * pocita procentualni odchylku od prumerneho proudu
- */
-float diff_p(float value){
-       return ((float)value-PRUM_PROUD)*100/PRUM_PROUD;
-}
-/*
- * pocita procentualni odchylku od prumerneho souctu proudu
- */
-float diff_s(float value){
-       return ((float)value-PRUM_SOUC)*100/PRUM_SOUC;
-}
+
 
 void prepare_tx(uint8_t * tx){