Now it is possible to log state data.

[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 3d13ff28a484b11ea43c62f6d61b7287d26ff4e5..bd676e4deb8c07b737c5ce2a1c0a2b08607ed8c0 100644 (file)
--- a/pmsm-control/test_sw/main_pmsm.c
+++ b/pmsm-control/test_sw/main_pmsm.c
@@ -57,7 +57,10 @@ struct rpi_state rps={
        .desired_spd=0,
        .spd_reg_ena=0,
        .old_pos={0},
-       .spd_err_sum=0
+       .spd_err_sum=0,
+       .log_col_count=0,       /* pocet radku zaznamu */
+       .log_col=0,
+       .doLogs=0
 };
 
 /**
@@ -95,6 +98,46 @@ int32_t min(int32_t x, int32_t y, int32_t z){
 
         return x;
 }
+
+/*
+ * \brief
+ * Free logs
+ */
+void freeLogs(){
+       int r;
+       if (rps.log_col_count){
+               for (r=0;r<LOG_ROWS;r++){
+                       free(rps.logs[r]);
+               }
+       }
+       rps.log_col_count=0;
+       rps.doLogs=0;
+}
+
+/*
+ * \brief
+ * Makes log.
+ */
+void makeLog(){
+       int r;
+       if (rps.log_col==MAX_LOGS-1){
+               rps.doLogs=0;
+               return;
+       }
+       rps.logs[0][rps.log_col]=(int)rps.tf_count;
+       rps.logs[1][rps.log_col]=(int)rps.spi_dat->pozice;
+
+       rps.log_col++;
+
+        if (rps.log_col==rps.log_col_count-1){
+               rps.log_col_count*=2;
+               rps.log_col_count%=MAX_LOGS;
+               for (r=0;r<LOG_ROWS;r++){
+                       rps.logs[r]=realloc(rps.logs[r],rps.log_col_count*sizeof(int));
+               }
+        }
+}
+
 /*
  * \brief
  * Pripravi psi buffer
@@ -177,6 +220,7 @@ void appl_stop(){
 
        spi_disable();
        clk_disable();
+       freeLogs();
        /*muzeme zavrit semafor*/
        sem_destroy(&rps.thd_par_sem);
         printf("\nprogram bezpecne ukoncen\n");
@@ -623,6 +667,12 @@ void * read_data(void* param){
                        }else if(!rps.index_ok && rps.commutate){
                                simple_hall_commutator(rps.duty);
                        }
+
+                       /*zalogujeme hodnoty*/
+                       if (rps.doLogs && !(rps.tf_count%LOG_PERIOD)){
+                               makeLog();
+                       }
+
                        sem_post(&rps.thd_par_sem);             /*--post semaphore---*/
 
                        /* calculate next shot */