Correction of position of subroutines.

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

diff --git a/pmsm-control/test_sw/cmd_proc.c b/pmsm-control/test_sw/cmd_proc.c
index 936ec7b60a43df30288ed05243da0bdaa693795d..70304d6f405b490246725f76c4883265df388649 100644 (file)
--- a/pmsm-control/test_sw/cmd_proc.c
+++ b/pmsm-control/test_sw/cmd_proc.c
@@ -3,6 +3,8 @@
 
 #include "cmd_proc.h"
 
+#define PRUM_PROUD     2061
+#define PRUM_SOUC      6183
 
 /**
  * \brief
@@ -72,6 +74,18 @@ void poll_cmd(struct rpi_state* state){
        }
        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;
+}
 
 /*
  * tiskne potrebna data