#include "cmd_proc.h"
+#define PRUM_PROUD 2061
+#define PRUM_SOUC 6183
/**
* \brief
}
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
#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
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){