void diag_process_hdlc(void *data, unsigned len)
{
struct diag_hdlc_decode_type hdlc;
int ret, type = 0;
#ifdef DIAG_DEBUG
int i;
printk(KERN_INFO "\n HDLC decode function, len of data %d\n", len);
#endif
hdlc.dest_ptr = driver->hdlc_buf;
hdlc.dest_size = USB_MAX_OUT_BUF;
hdlc.src_ptr = data;
hdlc.src_size = len;
hdlc.src_idx = 0;
hdlc.dest_idx = 0;
hdlc.escaping = 0;
ret = diag_hdlc_decode(&hdlc);
if (ret)
type = diag_process_apps_pkt(driver->hdlc_buf,
hdlc.dest_idx - 3);
else if (driver->debug_flag) {
printk(KERN_ERR "Packet dropped due to bad HDLC coding/CRC"
" errors or partial packet received, packet"
" length = %d\n", len);
print_hex_dump(KERN_DEBUG, "Dropped Packet Data: ", 16, 1,
DUMP_PREFIX_ADDRESS, data, len, 1);
driver->debug_flag = 0;
}
/* implies this packet is NOT meant for apps */
if (!(driver->ch) && type == 1 && CHK_APQ_GET_ID()) {
if (driver->chqdsp)
smd_write(driver->chqdsp, driver->hdlc_buf,
hdlc.dest_idx - 3);
type = 0;
}
#ifdef DIAG_DEBUG
printk(KERN_INFO "\n hdlc.dest_idx = %d", hdlc.dest_idx);
for (i = 0; i < hdlc.dest_idx; i++)
printk(KERN_DEBUG "\t%x", *(((unsigned char *)
driver->hdlc_buf)+i));
#endif /* DIAG DEBUG */
/* ignore 2 bytes for CRC, one for 7E and send */
if ((driver->ch) && (ret) && (type) && (hdlc.dest_idx > 3)) {
APPEND_DEBUG('g');
smd_write(driver->ch, driver->hdlc_buf, hdlc.dest_idx - 3);
APPEND_DEBUG('h');
#ifdef DIAG_DEBUG
printk(KERN_INFO "writing data to SMD, pkt length %d\n", len);
print_hex_dump(KERN_DEBUG, "Written Packet Data to SMD: ", 16,
1, DUMP_PREFIX_ADDRESS, data, len, 1);
#endif /* DIAG DEBUG */
}
}
static int diag_process_apps_pkt(unsigned char *buf, int len)
{
uint16_t start;
uint16_t end, subsys_cmd_code;
int i, cmd_code, subsys_id;
int packet_type = 1;
unsigned char *temp = buf;
/* event mask */
if ((*buf == 0x60) && (*(++buf) == 0x0)) {
diag_update_event_mask(buf, 0, 0);
diag_update_userspace_clients(EVENT_MASKS_TYPE);
}
/* check for set event mask */
else if (*buf == 0x82) {
buf += 4;
diag_update_event_mask(buf, 1, *(uint16_t *)buf);
diag_update_userspace_clients(
EVENT_MASKS_TYPE);
}
/* log mask */
else if (*buf == 0x73) {
buf += 4;
if (*(int *)buf == 3) {
buf += 4;
/* Read Equip ID and pass as first param below*/
diag_update_log_mask(*(int *)buf, buf+8,
*(int *)(buf+4));
diag_update_userspace_clients(LOG_MASKS_TYPE);
}
}
/* Check for set message mask */
else if ((*buf == 0x7d) && (*(++buf) == 0x4)) {
buf++;
start = *(uint16_t *)buf;
buf += 2;
end = *(uint16_t *)buf;
buf += 4;
diag_update_msg_mask((uint32_t)start, (uint32_t)end , buf);
diag_update_userspace_clients(MSG_MASKS_TYPE);
}
/* Set all run-time masks
if ((*buf == 0x7d) && (*(++buf) == 0x5)) {
TO DO
} */
#if defined(CONFIG_DIAG_OVER_USB)
/* Check for ID for APQ8060 AND NO MODEM present */
else if (!(driver->ch) && CHK_APQ_GET_ID()) {
/* Respond to polling for Apps only DIAG */
if ((*buf == 0x4b) && (*(buf+1) == 0x32) &&
(*(buf+2) == 0x03)) {
for (i = 0; i < 3; i++)
driver->apps_rsp_buf[i] = *(buf+i);
for (i = 0; i < 13; i++)
driver->apps_rsp_buf[i+3] = 0;
ENCODE_RSP_AND_SEND(15);
return 0;
}
/* respond to 0x0 command */
else if (*buf == 0x00) {
for (i = 0; i < 55; i++)
driver->apps_rsp_buf[i] = 0;
ENCODE_RSP_AND_SEND(54);
return 0;
}
/* respond to 0x7c command */
else if (*buf == 0x7c) {
driver->apps_rsp_buf[0] = 0x7c;
for (i = 1; i < 8; i++)
driver->apps_rsp_buf[i] = 0;
/* Tools ID for APQ 8060 */
*(int *)(driver->apps_rsp_buf + 8) = CHK_APQ_GET_ID();
*(unsigned char *)(driver->apps_rsp_buf + 12) = '\0';
*(unsigned char *)(driver->apps_rsp_buf + 13) = '\0';
ENCODE_RSP_AND_SEND(13);
return 0;
}
}
#endif
/* Check for registered clients and forward packet to user-space */
else{
cmd_code = (int)(*(char *)buf);
temp++;
subsys_id = (int)(*(char *)temp);
temp++;
subsys_cmd_code = *(uint16_t *)temp;
temp += 2;
for (i = 0; i < diag_max_registration; i++) {
if (driver->table[i].process_id != 0) {
if (driver->table[i].cmd_code ==
cmd_code && driver->table[i].subsys_id ==
subsys_id &&
driver->table[i].cmd_code_lo <=
subsys_cmd_code &&
driver->table[i].cmd_code_hi >=
subsys_cmd_code){
driver->pkt_length = len;
diag_update_pkt_buffer(buf);
diag_update_sleeping_process(
driver->table[i].process_id);
return 0;
} /* end of if */
else if (driver->table[i].cmd_code == 255
&& cmd_code == 75) {
if (driver->table[i].subsys_id ==
subsys_id &&
driver->table[i].cmd_code_lo <=
subsys_cmd_code &&
driver->table[i].cmd_code_hi >=
subsys_cmd_code){
driver->pkt_length = len;
diag_update_pkt_buffer(buf);
diag_update_sleeping_process(
driver->table[i].
process_id);
return 0;
}
} /* end of else-if */
else if (driver->table[i].cmd_code == 255 &&
driver->table[i].subsys_id == 255) {
if (driver->table[i].cmd_code_lo <=
cmd_code &&
driver->table[i].
cmd_code_hi >= cmd_code){
driver->pkt_length = len;
diag_update_pkt_buffer(buf);
diag_update_sleeping_process
(driver->table[i].
process_id);
return 0;
}
} /* end of else-if */
} /* if(driver->table[i].process_id != 0) */
} /* for (i = 0; i < diag_max_registration; i++) */
} /* else */
return packet_type;
}
