Diff: FPGA_bus.cpp

Revision:

14:b56473e54f6f

Parent:

13:67382358d024

Parent:

12:b9b4ff729fef

Child:

15:6420b52d30cc

diff -r 67382358d024 -r b56473e54f6f FPGA_bus.cpp
--- a/FPGA_bus.cpp	Sat May 02 22:49:47 2020 +0000
+++ b/FPGA_bus.cpp	Fri May 22 16:52:10 2020 +0000
@@ -15,42 +15,24 @@
  *      on the FPGA.
  */ 
  
- /*
-FPGA_bus::FPGA_bus(void)
-                :   async_uP_start(ASYNC_UP_START_PIN), 
+FPGA_bus::FPGA_bus(int nos_PWM   /* = NOS_PWM_CHANNELS */, 
+                   int nos_QE    /* = NOS_QE_CHANNELS  */, 
+                   int nos_servo /* = NOS_RC_CHANNELS  */ )
+                   
+                :   
+                    _nos_PWM_units(nos_PWM),
+                    _nos_QE_units(nos_QE),
+                    _nos_servo_units(nos_servo),   
+                                            
+                    async_uP_start(ASYNC_UP_START_PIN), 
                     async_uP_handshake_1(ASYNC_UP_HANDSHAKE_1_PIN),
                     async_uP_RW(ASYNC_UP_RW_PIN),
                     async_uP_reset(ASYNC_UP_RESET_PIN),
                     uP_ack(ASYNC_UP_ACK_PIN),
-                    uP_handshake_2(ASYNC_UP_HANDSHAKE_2_PIN)                   
-{
-    _nos_PWM_units   = NOS_PWM_CHANNELS;
-    _nos_QE_units    = NOS_QE_CHANNELS;
-    _nos_servo_units = NOS_RC_CHANNELS;
-    
-    async_uP_start       = LOW;
-}
- */
-FPGA_bus::FPGA_bus(int nos_PWM   /* = NOS_PWM_CHANNELS */, 
-                   int nos_QE    /* = NOS_QE_CHANNELS  */, 
-                   int nos_servo /* = NOS_RC_CHANNELS  */ )
-                   
-                :   async_uP_start(ASYNC_UP_START_PIN), 
-                    async_uP_handshake_1(ASYNC_UP_HANDSHAKE_1_PIN),
-                    async_uP_RW(ASYNC_UP_RW_PIN),
-                    async_uP_reset(ASYNC_UP_RESET_PIN),
-                    uP_ack(ASYNC_UP_ACK_PIN),
-                    uP_handshake_2(ASYNC_UP_HANDSHAKE_2_PIN)
-                    
- /*                     _nos_PWM_units(nos_PWM),
-                      _nos_QE_units(nos_QE),
-                      _nos_servo_units(nos_servo)        */       
-{
-    _nos_PWM_units   = nos_PWM;
-    _nos_QE_units    = nos_QE;
-    _nos_servo_units = nos_servo; 
-    
-    async_uP_start   = LOW;
+                    uP_handshake_2(ASYNC_UP_HANDSHAKE_2_PIN),
+                    log_pin(LOG_PIN)
+        {
+        async_uP_start   = LOW;
 }
 
 
@@ -72,6 +54,7 @@
     wait_us(20);
     
     global_FPGA_unit_error_flag = NO_ERROR;
+    log_pin = LOW;
 }
     
 void FPGA_bus::do_start(void)
@@ -140,17 +123,14 @@
                     uint32_t *data,
                     uint32_t *status)
 {
+    log_pin = HIGH;
     do_start();
- //   pc.printf("\n1");
     do_write(command, register_address, register_data);
- //   pc.printf(" 2");
     do_read(&in_pkt);
- //   pc.printf(" 3");
     do_end();
- //   pc.printf(" 4\n");
+    log_pin = LOW;
     *data = in_pkt.word_data[0];
     *status = in_pkt.word_data[1];
-   // pc.printf("data = %#08X  :: status = %#08X\n", in_pkt.word_data[0], in_pkt.word_data[1]);
 }
 
 uint32_t  FPGA_bus::do_command(FPGA_packet_t cmd_packet)
@@ -229,17 +209,36 @@
     global_FPGA_unit_error_flag = status;
 }
 
-void FPGA_bus::enable_speed_measure(uint32_t channel)
+void FPGA_bus::QE_config(uint32_t channel, uint32_t config_value)
 {
-    uint32_t register_address = ((QE_BASE + (channel * NOS_QE_REGISTERS)) + QE_CONFIG);
-    uint32_t register_data = QE_SPEED_CALC_ENABLE;
-    do_transaction(WRITE_REGISTER_CMD, register_address, register_data, &data, &status);
+    uint32_t register_address = ((PWM_BASE + (channel * NOS_PWM_REGISTERS)) + PWM_CONFIG);
+    do_transaction(WRITE_REGISTER_CMD, register_address , config_value, &data, &status);
+    global_FPGA_unit_error_flag = status;;
+}
+
+void FPGA_bus::enable_speed_measure(uint32_t channel, uint32_t config_value, uint32_t phase_time)
+{
+    uint32_t register_base = (QE_BASE + (channel * NOS_QE_REGISTERS));
+    do_transaction(WRITE_REGISTER_CMD, (register_base + QE_SIM_PHASE_TIME), phase_time, &data, &status);
+    global_FPGA_unit_error_flag = status;
+    if (status != NO_ERROR) {
+        return;
+    }
+    do_transaction(WRITE_REGISTER_CMD, (register_base + QE_CONFIG), config_value, &data, &status);
     global_FPGA_unit_error_flag = status;
 }
 
 uint32_t FPGA_bus::read_speed_measure(uint32_t channel)
 {
-    uint32_t register_address = ((QE_BASE + (channel * NOS_QE_REGISTERS)) + QE_CONFIG);
+    uint32_t register_address = ((QE_BASE + (channel * NOS_QE_REGISTERS)) + QE_SPEED_BUFFER);
+    do_transaction(READ_REGISTER_CMD, register_address, NULL, &data, &status);
+    global_FPGA_unit_error_flag = status;
+    return data;
+}
+
+uint32_t FPGA_bus::read_count_measure(uint32_t channel)
+{
+    uint32_t register_address = ((QE_BASE + (channel * NOS_QE_REGISTERS)) + QE_COUNT_BUFFER);
     do_transaction(READ_REGISTER_CMD, register_address, NULL, &data, &status);
     global_FPGA_unit_error_flag = status;
     return data;