X-Git-Url: https://rtime.felk.cvut.cz/gitweb/fpga/rpi-motor-control.git/blobdiff_plain/1cf729421e63f859e426a429f9ce935a86afd167..5d8290ceb4f6810b3bf47d15bcbb0fc63ff4a837:/pmsm-control/test_sw/pmsm_state.c

diff --git a/pmsm-control/test_sw/pmsm_state.c b/pmsm-control/test_sw/pmsm_state.c
new file mode 100644
index 0000000..9721490
--- /dev/null
+++ b/pmsm-control/test_sw/pmsm_state.c
@@ -0,0 +1,38 @@
+#include "pmsm_state.h"
+#include "commutators.h"
+
+/**
+ * Index Lost.
+ */
+void setIndexLost(struct rpi_state* this){
+	this->index_ok=0;
+	this->main_commutator=simple_hall_commutator;
+}
+
+/**
+ * Index OK.
+ */
+void setIndexOK(struct rpi_state* this){
+	this->index_ok=1;
+	this->main_commutator=inv_trans_comm_2;
+}
+
+/**
+ * Turn commutation on.
+ */
+void setCommutationOn(struct rpi_state* this){
+	this->commutate=1;
+	if (this->index_ok){
+		this->main_commutator=inv_trans_comm_2;
+	}else{
+		this->main_commutator=simple_hall_commutator;
+	}
+}
+
+/**
+ * Turn commutation off.
+ */
+void setCommutationOff(struct rpi_state* this){
+	this->commutate=0;
+	this->main_commutator=zero_commutator;
+}