Browse Source

add:jd9261t驱动
del:tp去除默认i2c初始化

Dozingfiretruck 10 months ago
parent
commit
cdb0f87ef5

+ 1 - 0
components/tp/luat_lib_tp.c

@@ -28,6 +28,7 @@ typedef struct tp_reg {
 
 static const tp_reg_t tp_regs[] = {
     {"gt911",  &tp_config_gt911},
+    {"jd9261t",  &tp_config_jd9261t},
 	{"jd9261t_inited",  &tp_config_jd9261t_inited},
     {"", NULL}
 };

+ 1 - 0
components/tp/luat_tp.h

@@ -57,6 +57,7 @@ typedef enum{
 
 
 extern luat_tp_opts_t tp_config_gt911;
+extern luat_tp_opts_t tp_config_jd9261t;
 extern luat_tp_opts_t tp_config_jd9261t_inited;
 
 int luat_tp_init(luat_tp_config_t* luat_tp_config);

+ 1 - 2
components/tp/luat_tp_gt911.c

@@ -234,7 +234,7 @@ static int tp_gt911_gpio_init(luat_tp_config_t* luat_tp_config){
     // luat_gpio_set(luat_tp_config->pin_int, Luat_GPIO_HIGH);
     /* 0x5D */
     luat_gpio_set(luat_tp_config->pin_int, Luat_GPIO_LOW);
-    
+
     if (luat_tp_config->pin_rst != LUAT_GPIO_NONE){
 
         luat_rtos_task_sleep(1);
@@ -255,7 +255,6 @@ static int tp_gt911_init(luat_tp_config_t* luat_tp_config){
     int ret = 0;
     luat_rtos_task_sleep(100);
     tp_gt911_gpio_init(luat_tp_config);
-    tp_i2c_init(luat_tp_config);
 
     ret = tp_gt911_detect(luat_tp_config);
     if (ret){

+ 445 - 0
components/tp/luat_tp_jd9261t.c

@@ -0,0 +1,445 @@
+#include "luat_base.h"
+#include "luat_tp.h"
+#include "luat_gpio.h"
+#include "luat_mem.h"
+#include "luat_rtos.h"
+#include "luat_tp_reg.h"
+
+#define LUAT_LOG_TAG "jd9261t"
+#include "luat_log.h"
+
+#define JD_ONE_SIZE    1
+#define JD_TWO_SIZE    2
+#define JD_THREE_SIZE  3
+#define JD_FOUR_SIZE   4
+#define JD_FIVE_SIZE   5
+#define JD_SIX_SIZE    6
+#define JD_SEVEN_SIZE  7
+#define JD_EIGHT_SIZE  8
+
+#define JT9261T_ADDRESS0              (0x68)
+#define JT9261T_ADDRESS1              (0x14)
+
+#define JT9261T_PRODUCT_ID_CODE       (0x9062)
+
+#define JT9261T_REG_RESET             (0x40008004)
+#define JT9261T_CMD_RESET             (0xA5)
+
+#define JT9261T_POR_INIT_REG          (0x40008081)
+#define JT9261T_PRODUCT_ID            (0x40008076)
+
+#define JT9261T_READ_COOR_ADDR        (0x20011120)
+#define JT9261T_REG_SLEEP             (0x8040)
+#define JT9261T_REG_SENSOR_ID         (0x814A)
+#define JT9261T_REG_CONFIG_DATA       (0x8047)
+#define JT9261T_REG_VERSION           (0x8140)
+#define JT9261T_REG_READ_POINT        (0x8150)
+#define JT9261T_REG_MODULE_SWITCH     (0x804D)
+#define JT9261T_REG_CONFIG_CHKSUM     (0x80FF)
+#define JT9261T_REG_CONFIG_FRESH      (0x8100)
+
+#define JT9261T_POINT_INFO_NUM        (6)
+#define JT9261T_TOUCH_NUMBER_MIN      (1)
+#define JT9261T_TOUCH_NUMBER_MAX      (10)
+
+#define JT9261T_REFRESH_RATE_MIN      (5)
+#define JT9261T_REFRESH_RATE_MAX      (20)
+
+typedef struct{
+    uint16_t x;
+    uint16_t y;
+    uint8_t w;
+    uint8_t test;
+}luat_tp_touch_t;
+
+typedef struct luat_touch_info{
+    uint8_t touch_num;
+    uint8_t test0;
+    uint8_t test1;
+    luat_tp_touch_t point[JT9261T_TOUCH_NUMBER_MAX];
+}luat_tp_info_t;
+
+static uint8_t jd9261t_init_state = 0;
+
+/* 根据官方推荐,使用后门方式 */
+static inline int jd9261t_Read_BackDoor_RegSingle(luat_tp_config_t* luat_tp_config, uint32_t addr, uint8_t *rdata){
+    int ReCode;
+    uint8_t addrBuf[JD_SIX_SIZE];
+
+    addrBuf[0] = 0xF3;
+    addrBuf[1] = (uint8_t)((addr & 0xFF000000) >> 24);
+    addrBuf[2] = (uint8_t)((addr & 0x00FF0000) >> 16);
+    addrBuf[3] = (uint8_t)((addr & 0x0000FF00) >> 8);
+    addrBuf[4] = (uint8_t)((addr & 0x000000FF) >> 0);
+    addrBuf[5] = 0x03;
+
+    return tp_i2c_read(luat_tp_config, addrBuf, sizeof(addrBuf), rdata, JD_ONE_SIZE, 0);
+}
+
+static inline int jd9261t_Write_BackDoor_RegSingle(luat_tp_config_t* luat_tp_config, uint32_t addr, uint8_t wdata){
+    uint8_t addrBuf[JD_SIX_SIZE];
+    uint8_t writeBuf[JD_ONE_SIZE];
+
+    addrBuf[0] = 0xF2;
+    addrBuf[1] = (uint8_t)((addr & 0xFF000000) >> 24);
+    addrBuf[2] = (uint8_t)((addr & 0x00FF0000) >> 16);
+    addrBuf[3] = (uint8_t)((addr & 0x0000FF00) >> 8);
+    addrBuf[4] = (uint8_t)((addr & 0x000000FF) >> 0);
+    addrBuf[5] = 0x03;
+    writeBuf[0] = wdata;
+
+    return tp_i2c_write(luat_tp_config, addrBuf, sizeof(addrBuf), writeBuf, sizeof(writeBuf));
+}
+
+static inline int jd9261t_Read_BackDoor_RegMulti(luat_tp_config_t* luat_tp_config, uint32_t addr, uint8_t *rdata, uint16_t rlen)
+{
+    uint8_t addrBuf[JD_SIX_SIZE];
+
+    addrBuf[0] = 0xF3;
+    addrBuf[1] = (uint8_t)((addr & 0xFF000000) >> 24);
+    addrBuf[2] = (uint8_t)((addr & 0x00FF0000) >> 16);
+    addrBuf[3] = (uint8_t)((addr & 0x0000FF00) >> 8);
+    addrBuf[4] = (uint8_t)((addr & 0x000000FF) >> 0);
+    addrBuf[5] = 0x03;
+
+    return tp_i2c_read(luat_tp_config, addrBuf, sizeof(addrBuf), rdata, rlen, 0);
+}
+
+static inline int jd9261t_Write_BackDoor_RegMulti(luat_tp_config_t* luat_tp_config, uint32_t addr, uint8_t *wdata, uint16_t wlen)
+{
+    uint8_t addrBuf[JD_SIX_SIZE];
+
+    addrBuf[0] = 0xF2;
+    addrBuf[1] = (uint8_t)((addr & 0xFF000000) >> 24);
+    addrBuf[2] = (uint8_t)((addr & 0x00FF0000) >> 16);
+    addrBuf[3] = (uint8_t)((addr & 0x0000FF00) >> 8);
+    addrBuf[4] = (uint8_t)((addr & 0x000000FF) >> 0);
+    addrBuf[5] = 0x03;
+
+    return tp_i2c_write(luat_tp_config, addrBuf, sizeof(addrBuf), wdata, wlen);
+}
+
+// static int jd9261t_obtain_config(luat_tp_config_t* luat_tp_config, uint8_t *config, uint8_t size){
+//     if (tp_i2c_read_reg16(luat_tp_config, JT9261T_CONFIG_REG, config, size, 1)){
+//         LLOGE("obtain config regs fail!");
+//         return -1;
+//     }
+//     uint8_t check_sum = 0;
+//     for (uint8_t index=0; index<size-2; index++){
+//         check_sum += config[index];
+//     }
+//     check_sum = (~check_sum) + 1;
+//     if (config[JT9261T_CHECK_SUM - JT9261T_CONFIG_REG] != check_sum){
+//         LLOGE("check sum 0X%02x and 0X%02x is not equal!", config[JT9261T_CHECK_SUM - JT9261T_CONFIG_REG], check_sum);
+//         return -1;
+//     }
+// 	return 0;
+// }
+
+// static int jd9261t_update_config(luat_tp_config_t* luat_tp_config, uint8_t *config, uint8_t size){
+// 	uint8_t check_sum = 0;
+// 	for (uint8_t index=0; index<size-2; index++){
+// 		check_sum += config[index];
+// 	}
+// 	check_sum = (~check_sum) + 1;
+// 	config[JT9261T_CHECK_SUM - JT9261T_CONFIG_REG] = check_sum;
+// 	config[JT9261T_CONFIG_FRESH - JT9261T_CONFIG_REG] = 1;
+// 	if (tp_i2c_write_reg16(luat_tp_config, JT9261T_CONFIG_REG, config, size)){
+// 		LLOGE("write config regs fail!");
+// 		return -1;
+// 	}
+// 	return 0;
+// }
+
+static int tp_jd9261t_detect(luat_tp_config_t* luat_tp_config){
+    uint16_t product_id = 0;
+    luat_tp_config->address = JT9261T_ADDRESS0;
+    jd9261t_Read_BackDoor_RegMulti(luat_tp_config, JT9261T_PRODUCT_ID, &product_id, sizeof(product_id));
+    if (product_id == JT9261T_PRODUCT_ID_CODE){
+        LLOGI("TP find device JT9261T ,address:0x%02X",luat_tp_config->address);
+        return 0;
+    }else{
+        luat_tp_config->address = JT9261T_ADDRESS1;
+        jd9261t_Read_BackDoor_RegMulti(luat_tp_config, JT9261T_PRODUCT_ID, &product_id, sizeof(product_id));
+        if (product_id == JT9261T_PRODUCT_ID_CODE){
+            LLOGI("TP find device JT9261T ,address:0x%02X",luat_tp_config->address);
+            return 0;
+        }else{
+            return -1;
+        }
+    }
+}
+
+static int luat_tp_irq_cb(int pin, void *args){
+    if (jd9261t_init_state == 0){
+        return -1;
+    }
+    luat_tp_config_t* luat_tp_config = (luat_tp_config_t*)args;
+    luat_tp_irq_enable(luat_tp_config, 0);
+    luat_rtos_message_send(luat_tp_config->task_handle, 1, args);
+    return 0;
+}
+
+static inline int tp_jd9261t_gpio_init(luat_tp_config_t* luat_tp_config){
+    if (luat_tp_config->pin_rst != LUAT_GPIO_NONE){
+        luat_gpio_mode(luat_tp_config->pin_rst, Luat_GPIO_OUTPUT, Luat_GPIO_DEFAULT, Luat_GPIO_LOW);
+        luat_gpio_set(luat_tp_config->pin_rst, Luat_GPIO_LOW);
+    }
+    if (luat_tp_config->pin_int != LUAT_GPIO_NONE){
+        luat_gpio_mode(luat_tp_config->pin_int, Luat_GPIO_OUTPUT, Luat_GPIO_DEFAULT, Luat_GPIO_LOW);
+        luat_gpio_set(luat_tp_config->pin_int, Luat_GPIO_LOW);
+    }
+
+    luat_gpio_set(luat_tp_config->pin_int, Luat_GPIO_HIGH);
+
+    if (luat_tp_config->pin_rst != LUAT_GPIO_NONE){
+            
+        luat_rtos_task_sleep(5);
+        luat_gpio_set(luat_tp_config->pin_rst, Luat_GPIO_HIGH);
+        luat_rtos_task_sleep(5);
+        luat_gpio_set(luat_tp_config->pin_rst, Luat_GPIO_LOW);
+        luat_rtos_task_sleep(50);
+        luat_gpio_set(luat_tp_config->pin_rst, Luat_GPIO_HIGH);
+        luat_rtos_task_sleep(100);
+    }
+    return 0;
+}
+
+static inline int tp_jd9261t_soft_reset(luat_tp_config_t* luat_tp_config){
+    return tp_i2c_write_reg32(luat_tp_config, JT9261T_REG_RESET, (uint8_t[]){JT9261T_CMD_RESET}, 1);
+}
+
+static inline int jd9261t_EnterBackDoor(luat_tp_config_t* luat_tp_config){
+    uint8_t addrBuf[JD_FIVE_SIZE];
+    uint8_t writeBuf[JD_ONE_SIZE];
+
+    addrBuf[0] = 0xF2;
+    addrBuf[1] = 0xAA;
+    addrBuf[2] = 0xF0;
+    addrBuf[3] = 0x0F;
+    addrBuf[4] = 0x55;
+    writeBuf[0] = 0x68;
+
+    return tp_i2c_write(luat_tp_config, addrBuf, sizeof(addrBuf), writeBuf, sizeof(writeBuf));
+}
+
+static inline int jd9261t_ExitBackDoor(luat_tp_config_t* luat_tp_config){
+    uint8_t addrBuf[JD_FIVE_SIZE];
+    uint8_t writeBuf[JD_ONE_SIZE];
+
+    addrBuf[0] = 0xF2;
+    addrBuf[1] = 0xAA;
+    addrBuf[2] = 0x88;
+    addrBuf[3] = 0x00;
+    addrBuf[4] = 0x00;
+    writeBuf[0] = 0x00;
+
+    return tp_i2c_write(luat_tp_config, addrBuf, sizeof(addrBuf), writeBuf, sizeof(writeBuf));
+}
+
+static int tp_jd9261t_init(luat_tp_config_t* luat_tp_config){
+    int ret = 0;
+    luat_rtos_task_sleep(100);
+
+    tp_jd9261t_gpio_init(luat_tp_config);
+
+    ret = tp_jd9261t_detect(luat_tp_config);
+    if (ret){
+        LLOGE("tp detect fail!");
+        return ret;
+    }
+
+    /* EnterBackDoor */
+    jd9261t_EnterBackDoor(luat_tp_config);
+
+    // uint8_t cfg_table[JT9261T_CONFIG_SIZE] = {0};
+    // jd9261t_obtain_config(luat_tp_config, cfg_table, JT9261T_CONFIG_SIZE);
+
+	// // renew config parameters.
+	// memcpy((uint8_t*)(&cfg_table[JT9261T_X_OUTPUT_MAX - JT9261T_CONFIG_REG]), (uint8_t*)(&luat_tp_config->w), 2);
+	// memcpy((uint8_t*)(&cfg_table[JT9261T_Y_OUTPUT_MAX - JT9261T_CONFIG_REG]), (uint8_t*)(&luat_tp_config->h), 2);
+
+	// if (LUAT_GPIO_RISING_IRQ == luat_tp_config->int_type){
+	// 	cfg_table[JT9261T_MODULE_SWITCH1 - JT9261T_CONFIG_REG] &= 0xFC;
+	// 	cfg_table[JT9261T_MODULE_SWITCH1 - JT9261T_CONFIG_REG] |= 0x00;
+	// }else if (LUAT_GPIO_FALLING_IRQ == luat_tp_config->int_type){
+	// 	cfg_table[JT9261T_MODULE_SWITCH1 - JT9261T_CONFIG_REG] &= 0xFC;
+	// 	cfg_table[JT9261T_MODULE_SWITCH1 - JT9261T_CONFIG_REG] |= 0x01;
+	// }
+
+	// // xy cordinate swap.
+	// if (luat_tp_config->swap_xy){
+	// 	cfg_table[JT9261T_MODULE_SWITCH1 - JT9261T_CONFIG_REG] &= 0xF7;
+	// 	cfg_table[JT9261T_MODULE_SWITCH1 - JT9261T_CONFIG_REG] |= 0x08;
+    // }
+	// // refresh rate.
+    // if (luat_tp_config->refresh_rate > JT9261T_REFRESH_RATE_MAX || luat_tp_config->refresh_rate == 0){
+	// 	cfg_table[JT9261T_REFRESH_RATE - JT9261T_CONFIG_REG] = JT9261T_REFRESH_RATE_MAX;
+	// }else if (luat_tp_config->refresh_rate < JT9261T_REFRESH_RATE_MIN){
+	// 	cfg_table[JT9261T_REFRESH_RATE - JT9261T_CONFIG_REG] = JT9261T_REFRESH_RATE_MIN;
+	// }else{
+	// 	cfg_table[JT9261T_REFRESH_RATE - JT9261T_CONFIG_REG] = luat_tp_config->refresh_rate - JT9261T_REFRESH_RATE_MIN;
+	// }
+	// // touch number.
+	// if (luat_tp_config->tp_num > JT9261T_TOUCH_NUMBER_MAX || luat_tp_config->tp_num == 0){
+	// 	cfg_table[JT9261T_TOUCH_NUMBER - JT9261T_CONFIG_REG] = JT9261T_TOUCH_NUMBER_MAX;
+	// }else if (luat_tp_config->tp_num < JT9261T_TOUCH_NUMBER_MIN){
+	// 	cfg_table[JT9261T_TOUCH_NUMBER - JT9261T_CONFIG_REG] = JT9261T_TOUCH_NUMBER_MIN;
+	// }else{
+	// 	cfg_table[JT9261T_TOUCH_NUMBER - JT9261T_CONFIG_REG] = luat_tp_config->tp_num;
+	// }
+
+    // jd9261t_update_config(luat_tp_config, cfg_table, JT9261T_CONFIG_SIZE);
+    
+    // // jd9261t_update_config(luat_tp_config, jd9261t_cfg_table, JT9261T_CONFIG_SIZE);
+
+    // // luat_rtos_task_sleep(5);
+    // // tp_jd9261t_soft_reset(luat_tp_config);
+
+    // luat_rtos_task_sleep(20);
+    // // tp_i2c_write_reg16(luat_tp_config, JT9261T_COMMAND_REG, (uint8_t[]){0x00}, 1);
+    
+    if (luat_tp_config->pin_int != LUAT_GPIO_NONE){
+        luat_gpio_t gpio = {0};
+        gpio.pin = luat_tp_config->pin_int;
+        gpio.mode = Luat_GPIO_IRQ;
+        gpio.pull = Luat_GPIO_DEFAULT;
+        gpio.irq = LUAT_GPIO_FALLING_IRQ;
+        gpio.irq_cb = luat_tp_irq_cb;
+        gpio.irq_args = luat_tp_config;
+        luat_gpio_setup(&gpio);
+    }
+
+    jd9261t_init_state = 1;
+    return ret;
+
+}
+
+static int tp_jd9261t_deinit(luat_tp_config_t* luat_tp_config){
+    jd9261t_init_state = 0;
+    if (luat_tp_config->pin_int != LUAT_GPIO_NONE){
+        luat_gpio_close(luat_tp_config->pin_int);
+    }
+    if (luat_tp_config->pin_rst != LUAT_GPIO_NONE){
+        luat_gpio_close(luat_tp_config->pin_rst);
+    }
+    return 0;
+}
+
+static void tp_jd9261t_read_done(luat_tp_config_t * luat_tp_config)
+{
+	luat_tp_irq_enable(luat_tp_config, 1);
+}
+
+// jd9261t get tp info.
+static int16_t pre_x[JT9261T_TOUCH_NUMBER_MAX] = {-1, -1, -1, -1, -1};
+static int16_t pre_y[JT9261T_TOUCH_NUMBER_MAX] = {-1, -1, -1, -1, -1};
+static int16_t pre_w[JT9261T_TOUCH_NUMBER_MAX] = {-1, -1, -1, -1, -1};
+static uint8_t s_tp_down[JT9261T_TOUCH_NUMBER_MAX];
+// static uint8_t read_buff[JT9261T_POINT_INFO_NUM * JT9261T_TOUCH_NUMBER_MAX];
+static luat_tp_info_t luat_touch_info = {0};
+
+void jd9261t_touch_up(void *buf, int8_t id){
+	luat_tp_data_t *read_data = (luat_tp_data_t *)buf;
+
+	if(s_tp_down[id] == 1){
+		s_tp_down[id] = 0;
+		read_data[id].event = TP_EVENT_TYPE_UP;
+	}else{
+		read_data[id].event = TP_EVENT_TYPE_NONE;
+	}
+
+	read_data[id].timestamp = luat_mcu_ticks();
+	read_data[id].width = pre_w[id];
+	read_data[id].x_coordinate = pre_x[id];
+	read_data[id].y_coordinate = pre_y[id];
+	read_data[id].track_id = id;
+
+	pre_x[id] = -1;  /* last point is none */
+	pre_y[id] = -1;
+	pre_w[id] = -1;
+}
+
+void jd9261t_touch_down(void *buf, int8_t id, int16_t x, int16_t y, int16_t w){
+	luat_tp_data_t *read_data = (luat_tp_data_t *)buf;
+
+	if (s_tp_down[id] == 1){
+		read_data[id].event = TP_EVENT_TYPE_MOVE;
+	}else{
+		read_data[id].event = TP_EVENT_TYPE_DOWN;
+		s_tp_down[id] = 1;
+	}
+
+	read_data[id].timestamp = luat_mcu_ticks();
+	read_data[id].width = w;
+	read_data[id].x_coordinate = x;
+	read_data[id].y_coordinate = y;
+	read_data[id].track_id = id;
+
+	pre_x[id] = x; /* save last point */
+	pre_y[id] = y;
+	pre_w[id] = w;
+}
+
+void jd9261t_read_point(luat_tp_touch_t *input_buff, void *buf, uint8_t touch_num){
+	luat_tp_touch_t *read_buf = input_buff;
+	uint8_t read_index;
+	int8_t read_id = 0;
+	int16_t input_x = 0;
+	int16_t input_y = 0;
+	int16_t input_w = 0;
+
+	static uint8_t pre_touch = 0;
+	static int8_t pre_id[JT9261T_TOUCH_NUMBER_MAX] = {0};
+
+	if (pre_touch > touch_num){                                       /* point up */
+		for (read_index = 0; read_index < pre_touch; read_index++){
+			uint8_t j;
+			for (j = 0; j < touch_num; j++){                          /* this time touch num */
+				read_id = j;
+				if (pre_id[read_index] == read_id)                   /* this id is not free */
+					break;
+
+				if (j >= touch_num - 1){
+					uint8_t up_id;
+					up_id = pre_id[read_index];
+					jd9261t_touch_up(buf, up_id);
+				}
+			}
+		}
+	}
+	if (touch_num){                                                 /* point down */
+		uint8_t off_set;
+		for (read_index = 0; read_index < touch_num; read_index++){
+			pre_id[read_index] = read_index;
+			input_x = read_buf[read_index].x;	/* x */
+			input_y = read_buf[read_index].y;	/* y */
+            input_w = read_buf[read_index].w;	/* w */
+			jd9261t_touch_down(buf, read_index, input_x, input_y, input_w);
+		}
+	}else if (pre_touch){
+		for(read_index = 0; read_index < pre_touch; read_index++){
+			jd9261t_touch_up(buf, pre_id[read_index]);
+		}
+	}
+	pre_touch = touch_num;
+}
+
+static int tp_jd9261t_read(luat_tp_config_t* luat_tp_config, luat_tp_data_t *luat_tp_data){
+    uint8_t touch_num=0, point_status=0;
+
+    jd9261t_Read_BackDoor_RegMulti(luat_tp_config, JT9261T_READ_COOR_ADDR, (uint8_t *)&luat_touch_info, sizeof(luat_touch_info));
+    
+    touch_num = luat_touch_info.touch_num;
+    jd9261t_read_point(luat_touch_info.point, luat_tp_data, luat_touch_info.touch_num);
+
+    return touch_num;
+}
+
+luat_tp_opts_t tp_config_jd9261t = {
+    .name = "jd9261t",
+    .init = tp_jd9261t_init,
+    .deinit = tp_jd9261t_deinit,
+    .read = tp_jd9261t_read,
+	.read_done = tp_jd9261t_read_done,
+};

+ 0 - 9
components/tp/luat_tp_reg.h

@@ -3,15 +3,6 @@
 
 #include "luat_i2c.h"
 
-static inline int tp_i2c_init(luat_tp_config_t* luat_tp_config){
-    if (luat_tp_config->soft_i2c != NULL){
-        i2c_soft_setup(luat_tp_config->soft_i2c);
-    }else{
-        luat_i2c_setup(luat_tp_config->i2c_id, I2C_SPEED_FAST);
-    }
-    return 0;
-}
-
 static inline int tp_i2c_write(luat_tp_config_t* luat_tp_config, uint8_t* cmd, size_t cmd_len, void* data, size_t data_len){
     size_t len = cmd_len+data_len;
     uint8_t data_reg[len];