diff --git a/src/drivers/boards/aerofc-v1/board_config.h b/src/drivers/boards/aerofc-v1/board_config.h index 23179e66d2a92b0f612ffd26ba58542b2e0f0f66..5c6ddb6298cf421904880c8eb1a239989ad7fd2b 100644 --- a/src/drivers/boards/aerofc-v1/board_config.h +++ b/src/drivers/boards/aerofc-v1/board_config.h @@ -142,8 +142,6 @@ /* * ESCs do not respond */ -#define BOARD_TAP_ESC_NO_VERIFY_CONFIG 1 - #define BOARD_TAP_ESC_MODE 1 #define MEMORY_CONSTRAINED_SYSTEM diff --git a/src/drivers/tap_esc/tap_esc.cpp b/src/drivers/tap_esc/tap_esc.cpp index 700a197004fe79ba1d456d54c41bf32504cab626..498709ed4be4464e525597b9e1bb8a078ec64c01 100644 --- a/src/drivers/tap_esc/tap_esc.cpp +++ b/src/drivers/tap_esc/tap_esc.cpp @@ -64,10 +64,6 @@ #include "drv_tap_esc.h" -#if !defined(BOARD_TAP_ESC_NO_VERIFY_CONFIG) -# define BOARD_TAP_ESC_NO_VERIFY_CONFIG 0 -#endif - #if !defined(BOARD_TAP_ESC_MODE) # define BOARD_TAP_ESC_MODE 0 #endif @@ -310,55 +306,6 @@ TAP_ESC::init() return ret; } -#if !BOARD_TAP_ESC_NO_VERIFY_CONFIG - - /* Verify All ESC got the config */ - - for (uint8_t cid = 0; cid < _channels_count; cid++) { - - /* Send the InfoRequest querying CONFIG_BASIC */ - EscPacket packet_info = {0xfe, sizeof(InfoRequest), ESCBUS_MSG_ID_REQUEST_INFO}; - InfoRequest &info_req = packet_info.d.reqInfo; - info_req.channelID = cid; - info_req.requestInfoType = REQEST_INFO_BASIC; - - ret = tap_esc_common::send_packet(_uart_fd, packet_info, cid); - - if (ret < 0) { - return ret; - } - - /* Get a response */ - - int retries = 10; - bool valid = false; - - while (retries--) { - - tap_esc_common::read_data_from_uart(_uart_fd, &uartbuf); - - if (!tap_esc_common::parse_tap_esc_feedback(&uartbuf, &_packet)) { - valid = (_packet.msg_id == ESCBUS_MSG_ID_CONFIG_INFO_BASIC - && _packet.d.rspConfigInfoBasic.channelID == cid - && 0 == memcmp(&_packet.d.rspConfigInfoBasic.resp, &config, sizeof(ConfigInfoBasicRequest))); - break; - - } else { - - /* Give it time to come in */ - - usleep(1000); - } - } - - if (!valid) { - return -EIO; - } - - } - -#endif - /* To Unlock the ESC from the Power up state we need to issue 10 * ESCBUS_MSG_ID_RUN request with all the values 0; */