diff --git a/edc20.c b/edc20.c index 51e470b..ca19443 100644 --- a/edc20.c +++ b/edc20.c @@ -241,71 +241,6 @@ static void dev_mode_set_adc(uint8_t *ins, uint16_t size) } } -void gpio_set_to_vo_mode_config(void) -{ - nrf_gpio_pin_set(Vout_FB_PIN); - nrf_gpio_pin_clear(Vout_IN_PIN); -} - -void gpio_set_to_cv_or_cc_mode_config(void) -{ - nrf_gpio_pin_clear(Vout_FB_PIN); - nrf_gpio_pin_set(Vout_IN_PIN); -} - -void switch_set_to_vo_mode_config(void) -{ - sw_t sw; - uint32_t sw_cnt; - - sw_count(&sw_cnt); - sw_read(&sw); - sw.sw4 = 0; - sw.sw5 = 0; - sw.sw6 = 0; - sw.sw7 = 1; - NRF_LOG_INFO("sw.val= %08X", sw.val); - NRF_LOG_INFO("sw.sw7~sw4=%X %X %X %X", sw.sw7, sw.sw6, sw.sw5, sw.sw4); - NRF_LOG_INFO("sw.sw3~sw0=%X %X %X %X", sw.sw3, sw.sw2, sw.sw1, sw.sw0); - sw_write(sw); -} - -void switch_set_to_cv_or_cc_mode_config(uint8_t vout_resistance_idx) -{ - sw_t sw; - uint32_t sw_cnt; - - sw_count(&sw_cnt); - sw_read(&sw); - - if (vout_resistance_idx == 0x00) - { - sw.sw4 = 0; - sw.sw5 = 0; - sw.sw6 = 1; - sw.sw7 = 0; - } - if (vout_resistance_idx == 0x01) - { - sw.sw4 = 0; - sw.sw5 = 1; - sw.sw6 = 0; - sw.sw7 = 0; - } - if (vout_resistance_idx == 0x02) - { - sw.sw4 = 1; - sw.sw5 = 0; - sw.sw6 = 0; - sw.sw7 = 0; - } - - NRF_LOG_INFO("sw.val= %08X", sw.val); - NRF_LOG_INFO("sw.sw7~sw4=%X %X %X %X", sw.sw7, sw.sw6, sw.sw5, sw.sw4); - NRF_LOG_INFO("sw.sw3~sw0=%X %X %X %X", sw.sw3, sw.sw2, sw.sw1, sw.sw0); - sw_write(sw); -} - /* dev_mode_set_switch (1)0x3000FF9200 @@ -326,16 +261,6 @@ void switch_set_to_cv_or_cc_mode_config(uint8_t vout_resistance_idx) 00000111b = U13 S3&S2&S1 close(conductivity) 00001111b = U13 S4&S3&S2&S1 close(conductivity) - (3)0x3000FF9202 - -func: vout mode config - - (4)0x3000FF9203rr - -func: cv/cc mode config - -rr: Vout resistance idx 00h-02h - 00h = the smallest Vout resistance (100R) - 01h = the middle Vout resistance (10K) - 02h = the largest Vout resistance (1M) - (3)0x3000FF9204gg -func: out_1 gain config -gg: out_1 resistance idx 00h-02h @@ -347,8 +272,6 @@ static void dev_mode_set_switch(uint8_t *ins, uint16_t size) { #define SW_ITEM_INIT_SW 0x00 #define SW_ITEM_WRITE_SW 0x01 -#define SW_ITEM_VOUT_MODE_CFG 0x02 -#define SW_ITEM_CV_CC_MODE_CFG 0x03 #define SW_ITEM_SET_OUT_1_GAIN 0x04 uint8_t sw_item = ins[4]; @@ -373,19 +296,6 @@ static void dev_mode_set_switch(uint8_t *ins, uint16_t size) break; } - case SW_ITEM_VOUT_MODE_CFG: { - switch_set_to_vo_mode_config(); - gpio_set_to_vo_mode_config(); - break; - } - - case SW_ITEM_CV_CC_MODE_CFG: { - uint8_t vout_resistance_idx = ins[5]; - switch_set_to_cv_or_cc_mode_config(vout_resistance_idx); - gpio_set_to_vo_mode_config(); - break; - } - case SW_ITEM_SET_OUT_1_GAIN: { uint8_t out_1_gain = ins[5]; sw_t sw;