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; }