Donate to e Foundation | Murena handsets with /e/OS | Own a part of Murena! Learn more

Commit ec745dac authored by Hardik Arya's avatar Hardik Arya
Browse files

diag: Add support for diag feature query command 



The Diag Feature Query Command is intended to be used to
communicate feature differences of specific devices that
may impact interaction with a host tool. The patch adds
support for the same command.

Change-Id: I4f0a8ac6b609692eb94849104da61465719822c2
Signed-off-by: default avatarHardik Arya <harya@codeaurora.org>
parent 7cb74543

drivers/char/diag/diagchar.h

+12 −0
Original line number Diff line number Diff line
@@ -134,6 +134,7 @@ 
#define DIAG_GET_TIME_API	0x21B

#define DIAG_SET_TIME_API	0x21C

#define DIAG_GET_DIAG_ID	0x222

#define DIAG_FEATURE_QUERY	0x225

#define DIAG_SWITCH_COMMAND	0x081B

#define DIAG_BUFFERING_MODE	0x080C
@@ -175,6 +176,10 @@ 


#define FEATURE_MASK_LEN	4



#define F_DIAG_EVENT_REPORT	0

#define F_DIAG_HW_ACCELERATION	1

#define F_DIAG_MULTI_SIM_MASK	2



#define DIAG_MD_NONE			0

#define DIAG_MD_PERIPHERAL		1
@@ -457,6 +462,12 @@ struct diag_cmd_hdlc_disable_rsp_t { 
	uint8_t result;

};



struct diag_cmd_feature_query_rsp_t {

	struct diag_pkt_header_t header;

	uint8_t version;

	uint8_t feature_len;

};



struct diag_pkt_frame_t {

	uint8_t start;

	uint8_t version;
@@ -628,6 +639,7 @@ struct diagchar_dev { 
	struct diagfwd_info *diagfwd_cmd[NUM_PERIPHERALS];

	struct diagfwd_info *diagfwd_dci_cmd[NUM_PERIPHERALS];

	struct diag_feature_t feature[NUM_PERIPHERALS];

	uint32_t apps_feature;

	struct diag_buffering_mode_t buffering_mode[NUM_MD_SESSIONS];

	uint8_t buffering_flag[NUM_MD_SESSIONS];

	struct mutex mode_lock;

drivers/char/diag/diagfwd.c

+52 −0
Original line number Diff line number Diff line
@@ -42,6 +42,8 @@ 
#define STM_RSP_NUM_BYTES		9

#define RETRY_MAX_COUNT		1000



#define SET_APPS_FEATURE(driver, n) ((driver->apps_feature) |= (1 << (n)))



struct diag_md_hdlc_reset_work {

	int pid;

	struct work_struct work;
@@ -983,6 +985,43 @@ static int diag_cmd_disable_hdlc(unsigned char *src_buf, int src_len, 
	return write_len;

}



int diag_cmd_feature_query(unsigned char *src_buf, int src_len,

				      unsigned char *dest_buf, int dest_len)

{

	int write_len = 0;

	struct diag_pkt_header_t *header = NULL;

	struct diag_cmd_feature_query_rsp_t rsp;



	if (!src_buf || !dest_buf || src_len <= sizeof(struct diag_pkt_header_t)

			|| dest_len <= 0 || dest_len > DIAG_MAX_RSP_SIZE) {

		pr_err("diag: Feature query, invalid input src_buf: %pK, src_len: %d, dest_buf: %pK, dest_len: %d\n",

			src_buf, src_len, dest_buf, dest_len);

		return -EINVAL;

	}



	header = (struct diag_pkt_header_t *)src_buf;



	rsp.header.cmd_code = header->cmd_code;

	rsp.header.subsys_id = header->subsys_id;

	rsp.header.subsys_cmd_code = header->subsys_cmd_code;

	rsp.version = 1;

	rsp.feature_len = sizeof(driver->apps_feature);

	if (dest_len < (sizeof(rsp) + sizeof(driver->apps_feature)))

		return -EINVAL;

	memcpy(dest_buf, &rsp, sizeof(rsp));

	memcpy(dest_buf + sizeof(rsp), &(driver->apps_feature),

			sizeof(driver->apps_feature));

	write_len = sizeof(rsp) + sizeof(driver->apps_feature);

	return write_len;

}



static void diag_init_apps_feature(void)

{

	driver->apps_feature = 0;



	SET_APPS_FEATURE(driver, F_DIAG_EVENT_REPORT);

}



void diag_send_error_rsp(unsigned char *buf, int len,

			int pid)

{
@@ -1123,6 +1162,17 @@ int diag_process_apps_pkt(unsigned char *buf, int len, int pid) 
			diag_send_rsp(driver->apps_rsp_buf, write_len, pid);

		return 0;

	}

	/* Check for Diag Feature Query command */

	else if ((*buf == DIAG_CMD_DIAG_SUBSYS) &&

		(*(buf+1) == DIAG_SS_DIAG) &&

		(*(uint16_t *)(buf+2) == DIAG_FEATURE_QUERY)) {

		write_len = diag_cmd_feature_query(buf, len,

							driver->apps_rsp_buf,

							DIAG_MAX_RSP_SIZE);

		if (write_len > 0)

			diag_send_rsp(driver->apps_rsp_buf, write_len, pid);

		return 0;

	}

	/* Check for download command */

	else if ((chk_apps_master()) && (*buf == 0x3A)) {

		/* send response back */
@@ -1910,6 +1960,8 @@ int diagfwd_init(void) 
		driver->feature[i].diag_id_support = 0;

	}



	diag_init_apps_feature();



	for (i = 0; i < NUM_MD_SESSIONS; i++) {

		driver->buffering_mode[i].peripheral = i;

		driver->buffering_mode[i].mode = DIAG_BUFFERING_MODE_STREAMING;