134 files changed, 31073 insertions, 30287 deletions
diff --git a/tvapi/libtv/tvutils/serial_base.cpp b/tvapi/libtv/tvutils/serial_base.cpp index e062c3b..8a5a98b 100644 --- a/tvapi/libtv/tvutils/serial_base.cpp +++ b/tvapi/libtv/tvutils/serial_base.cpp @@ -39,428 +39,428 @@ static int name_arr[] = { 115200, 38400, 19200, 9600, 4800, 2400, 1200, 300, 384 static int open_com_dev(int *dev_handle, char *dev_path) { - if (*dev_handle < 0) { - *dev_handle = open(dev_path, O_RDWR); - if (*dev_handle < 0) { - LOGE("%s, Can't Open Serial Port %s", "TV", dev_path); - } - } - - return *dev_handle; + if (*dev_handle < 0) { + *dev_handle = open(dev_path, O_RDWR); + if (*dev_handle < 0) { + LOGE("%s, Can't Open Serial Port %s", "TV", dev_path); + } + } + + return *dev_handle; } static int close_com_dev(int *dev_handle) { - if (*dev_handle >= 0) { - close(*dev_handle); - *dev_handle = -1; - } + if (*dev_handle >= 0) { + close(*dev_handle); + *dev_handle = -1; + } - return 0; + return 0; } static __inline__ int cfsetdatabits(struct termios *s, int db) { - if (db == 5) { - s->c_cflag = (s->c_cflag & ~CSIZE) | (CS5 & CSIZE); - } else if (db == 6) { - s->c_cflag = (s->c_cflag & ~CSIZE) | (CS6 & CSIZE); - } else if (db == 7) { - s->c_cflag = (s->c_cflag & ~CSIZE) | (CS7 & CSIZE); - } else if (db == 8) { - s->c_cflag = (s->c_cflag & ~CSIZE) | (CS8 & CSIZE); - } else { - LOGE("%s, Unsupported data size!\n", "TV"); - } - - return 0; + if (db == 5) { + s->c_cflag = (s->c_cflag & ~CSIZE) | (CS5 & CSIZE); + } else if (db == 6) { + s->c_cflag = (s->c_cflag & ~CSIZE) | (CS6 & CSIZE); + } else if (db == 7) { + s->c_cflag = (s->c_cflag & ~CSIZE) | (CS7 & CSIZE); + } else if (db == 8) { + s->c_cflag = (s->c_cflag & ~CSIZE) | (CS8 & CSIZE); + } else { + LOGE("%s, Unsupported data size!\n", "TV"); + } + + return 0; } static __inline__ int cfsetstopbits(struct termios *s, int sb) { - if (sb == 1) { - s->c_cflag &= ~CSTOPB; - } else if (sb == 2) { - s->c_cflag |= CSTOPB; - } else { - LOGE("%s, Unsupported stop bits!\n", "TV"); - } - - return 0; + if (sb == 1) { + s->c_cflag &= ~CSTOPB; + } else if (sb == 2) { + s->c_cflag |= CSTOPB; + } else { + LOGE("%s, Unsupported stop bits!\n", "TV"); + } + + return 0; } static __inline__ int cfsetparity(struct termios *s, int pb) { - if (pb == 'n' || pb == 'N') { - s->c_cflag &= ~PARENB; /* Clear parity enable */ - s->c_cflag &= ~INPCK; /* Enable parity checking */ - } else if (pb == 'o' || pb == 'O') { - s->c_cflag |= (PARODD | PARENB); - s->c_cflag |= INPCK; /* Disable parity checking */ - } else if (pb == 'e' || pb == 'E') { - s->c_cflag |= PARENB; /* Enable parity */ - s->c_cflag &= ~PARODD; - s->c_iflag |= INPCK; /* Disable parity checking */ - } else if (pb == 's' || pb == 'S') { - s->c_cflag &= ~PARENB; - s->c_cflag &= ~CSTOPB; - s->c_cflag |= INPCK; /* Disable parity checking */ - } else { - LOGE("%s, Unsupported parity!\n", "TV"); - } - - return 0; + if (pb == 'n' || pb == 'N') { + s->c_cflag &= ~PARENB; /* Clear parity enable */ + s->c_cflag &= ~INPCK; /* Enable parity checking */ + } else if (pb == 'o' || pb == 'O') { + s->c_cflag |= (PARODD | PARENB); + s->c_cflag |= INPCK; /* Disable parity checking */ + } else if (pb == 'e' || pb == 'E') { + s->c_cflag |= PARENB; /* Enable parity */ + s->c_cflag &= ~PARODD; + s->c_iflag |= INPCK; /* Disable parity checking */ + } else if (pb == 's' || pb == 'S') { + s->c_cflag &= ~PARENB; + s->c_cflag &= ~CSTOPB; + s->c_cflag |= INPCK; /* Disable parity checking */ + } else { + LOGE("%s, Unsupported parity!\n", "TV"); + } + + return 0; } static int gOriAttrGetFlag = 0; static struct termios gOriAttrValue; static __inline__ int com_get_attr(int fd, struct termios *s) { - if (gOriAttrGetFlag == 0) { - if (tcgetattr(fd, s) != 0) { - return -1; - } + if (gOriAttrGetFlag == 0) { + if (tcgetattr(fd, s) != 0) { + return -1; + } - gOriAttrGetFlag = 1; - gOriAttrValue = *s; - } + gOriAttrGetFlag = 1; + gOriAttrValue = *s; + } - *s = gOriAttrValue; + *s = gOriAttrValue; - return 0; + return 0; } static int com_set_opt(int hComm, int speed, int db, int sb, int pb, int to, int raw_mode) { - int i = 0; - struct termios tmpOpt; - - if (com_get_attr(hComm, &tmpOpt) != 0) { - LOGE("%s, get serial attr error(%s)!\n", "TV", strerror(errno)); - return -1; - } - - for (i = 0; i < sizeof(speed_arr) / sizeof(int); i++) { - if (speed == name_arr[i]) { - cfsetispeed(&tmpOpt, speed_arr[i]); - cfsetospeed(&tmpOpt, speed_arr[i]); - break; - } - } - - cfsetdatabits(&tmpOpt, db); - cfsetstopbits(&tmpOpt, sb); - cfsetparity(&tmpOpt, pb); - - if (to >= 0) { - tmpOpt.c_cc[VTIME] = to; /* 设置超时15 seconds*/ - tmpOpt.c_cc[VMIN] = 0; /* Update the options and do it NOW */ - } - - if (raw_mode == 1) { - cfmakeraw(&tmpOpt); - } - - tcflush(hComm, TCIOFLUSH); - if (tcsetattr(hComm, TCSANOW, &tmpOpt) < 0) { - LOGE("%s, set serial attr error(%s)!\n", "TV", strerror(errno)); - return -1; - } - tcflush(hComm, TCIOFLUSH); - - return 0; + int i = 0; + struct termios tmpOpt; + + if (com_get_attr(hComm, &tmpOpt) != 0) { + LOGE("%s, get serial attr error(%s)!\n", "TV", strerror(errno)); + return -1; + } + + for (i = 0; i < sizeof(speed_arr) / sizeof(int); i++) { + if (speed == name_arr[i]) { + cfsetispeed(&tmpOpt, speed_arr[i]); + cfsetospeed(&tmpOpt, speed_arr[i]); + break; + } + } + + cfsetdatabits(&tmpOpt, db); + cfsetstopbits(&tmpOpt, sb); + cfsetparity(&tmpOpt, pb); + + if (to >= 0) { + tmpOpt.c_cc[VTIME] = to; /* 设置超时15 seconds*/ + tmpOpt.c_cc[VMIN] = 0; /* Update the options and do it NOW */ + } + + if (raw_mode == 1) { + cfmakeraw(&tmpOpt); + } + + tcflush(hComm, TCIOFLUSH); + if (tcsetattr(hComm, TCSANOW, &tmpOpt) < 0) { + LOGE("%s, set serial attr error(%s)!\n", "TV", strerror(errno)); + return -1; + } + tcflush(hComm, TCIOFLUSH); + + return 0; } static int com_write_data(int hComm, const unsigned char *pData, unsigned int uLen) { - unsigned int len; - - if (hComm < 0) { - return -1; - } - - if (pData == NULL) { - return -1; - } - - LOGD("%s, write %d bytes\n", "TV", uLen); - - len = write(hComm, pData, uLen); - if (len == uLen) { - LOGD("%s, write data success\n", "TV"); - return len; - } else { - tcflush(hComm, TCOFLUSH); - LOGE("%s, write data failed and tcflush hComm\n", "TV"); - return -1; - } + unsigned int len; + + if (hComm < 0) { + return -1; + } + + if (pData == NULL) { + return -1; + } + + LOGD("%s, write %d bytes\n", "TV", uLen); + + len = write(hComm, pData, uLen); + if (len == uLen) { + LOGD("%s, write data success\n", "TV"); + return len; + } else { + tcflush(hComm, TCOFLUSH); + LOGE("%s, write data failed and tcflush hComm\n", "TV"); + return -1; + } } static int com_read_data(int hComm, char *pData, unsigned int uLen) { - char inbuff[uLen]; - char buff[uLen]; - char tempbuff[uLen]; - int i = 0, j = 0; - - memset(inbuff, '\0', uLen); - memset(buff, '\0', uLen); - memset(tempbuff, '\0', uLen); - - if (hComm < 0) { - return -1; - } - - char *p = inbuff; - - fd_set readset; - struct timeval tv; - int MaxFd = 0; - - unsigned int c = 0; - int z, k; - - do { - FD_ZERO(&readset); - FD_SET(hComm, &readset); - MaxFd = hComm + 1; - tv.tv_sec = 0; - tv.tv_usec = 100000; - do { - z = select(MaxFd, &readset, 0, 0, &tv); - } while (z == -1 && errno == EINTR); - - if (z == -1) { - hComm = -1; - break; - } - - if (z == 0) { - hComm = -1; - break; - } - - if (FD_ISSET(hComm, &readset)) { - z = read(hComm, buff, uLen - c); + char inbuff[uLen]; + char buff[uLen]; + char tempbuff[uLen]; + int i = 0, j = 0; + + memset(inbuff, '\0', uLen); + memset(buff, '\0', uLen); + memset(tempbuff, '\0', uLen); + + if (hComm < 0) { + return -1; + } + + char *p = inbuff; + + fd_set readset; + struct timeval tv; + int MaxFd = 0; + + unsigned int c = 0; + int z, k; + + do { + FD_ZERO(&readset); + FD_SET(hComm, &readset); + MaxFd = hComm + 1; + tv.tv_sec = 0; + tv.tv_usec = 100000; + do { + z = select(MaxFd, &readset, 0, 0, &tv); + } while (z == -1 && errno == EINTR); + + if (z == -1) { + hComm = -1; + break; + } + + if (z == 0) { + hComm = -1; + break; + } + + if (FD_ISSET(hComm, &readset)) { + z = read(hComm, buff, uLen - c); #if 0 - for (k = 0; k < z; k++) { - LOGD("%s, inbuff[%d]:%02X", "TV", k, buff[k]); - } + for (k = 0; k < z; k++) { + LOGD("%s, inbuff[%d]:%02X", "TV", k, buff[k]); + } #endif - c += z; - - if (z > 0) { - if (z < (signed int) uLen) { - buff[z + 1] = '\0'; - memcpy(p, buff, z); - p += z; - } else { - memcpy(inbuff, buff, z); - } - - memset(buff, '\0', uLen); - } else { - hComm = -1; - } - - if (c >= uLen) { - hComm = -1; - break; - } - } - } while (hComm >= 0); - - memcpy(pData, inbuff, c); - p = NULL; - return c; + c += z; + + if (z > 0) { + if (z < (signed int) uLen) { + buff[z + 1] = '\0'; + memcpy(p, buff, z); + p += z; + } else { + memcpy(inbuff, buff, z); + } + + memset(buff, '\0', uLen); + } else { + hComm = -1; + } + + if (c >= uLen) { + hComm = -1; + break; + } + } + } while (hComm >= 0); + + memcpy(pData, inbuff, c); + p = NULL; + return c; } int com_a_open_dev() { - int tmp_ret = 0; + int tmp_ret = 0; - pthread_mutex_lock(&serial_a_op_mutex); + pthread_mutex_lock(&serial_a_op_mutex); - tmp_ret = open_com_dev(&gSerialAHandle, CS_SERIAL_A_DEV_PATH); + tmp_ret = open_com_dev(&gSerialAHandle, CS_SERIAL_A_DEV_PATH); - pthread_mutex_unlock(&serial_a_op_mutex); + pthread_mutex_unlock(&serial_a_op_mutex); - return tmp_ret; + return tmp_ret; } int com_b_open_dev() { - int tmp_ret = 0; + int tmp_ret = 0; - pthread_mutex_lock(&serial_b_op_mutex); + pthread_mutex_lock(&serial_b_op_mutex); - tmp_ret = open_com_dev(&gSerialBHandle, CS_SERIAL_B_DEV_PATH); + tmp_ret = open_com_dev(&gSerialBHandle, CS_SERIAL_B_DEV_PATH); - pthread_mutex_unlock(&serial_b_op_mutex); + pthread_mutex_unlock(&serial_b_op_mutex); - return tmp_ret; + return tmp_ret; } int com_a_close_dev() { - int tmp_ret = 0; + int tmp_ret = 0; - pthread_mutex_lock(&serial_a_op_mutex); + pthread_mutex_lock(&serial_a_op_mutex); - tmp_ret = close_com_dev(&gSerialAHandle); + tmp_ret = close_com_dev(&gSerialAHandle); - pthread_mutex_unlock(&serial_a_op_mutex); + pthread_mutex_unlock(&serial_a_op_mutex); - return tmp_ret; + return tmp_ret; } int com_b_close_dev() { - int tmp_ret = 0; + int tmp_ret = 0; - pthread_mutex_lock(&serial_b_op_mutex); + pthread_mutex_lock(&serial_b_op_mutex); - tmp_ret = close_com_dev(&gSerialBHandle); + tmp_ret = close_com_dev(&gSerialBHandle); - pthread_mutex_unlock(&serial_b_op_mutex); + pthread_mutex_unlock(&serial_b_op_mutex); - return tmp_ret; + return tmp_ret; } int com_a_get_dev() { - int tmp_ret = 0; + int tmp_ret = 0; - pthread_mutex_lock(&serial_a_op_mutex); + pthread_mutex_lock(&serial_a_op_mutex); - tmp_ret = gSerialAHandle; + tmp_ret = gSerialAHandle; - pthread_mutex_unlock(&serial_a_op_mutex); + pthread_mutex_unlock(&serial_a_op_mutex); - return tmp_ret; + return tmp_ret; } int com_b_get_dev() { - int tmp_ret = 0; + int tmp_ret = 0; - pthread_mutex_lock(&serial_b_op_mutex); + pthread_mutex_lock(&serial_b_op_mutex); - tmp_ret = gSerialBHandle; + tmp_ret = gSerialBHandle; - pthread_mutex_unlock(&serial_b_op_mutex); + pthread_mutex_unlock(&serial_b_op_mutex); - return tmp_ret; + return tmp_ret; } int com_a_set_opt(int speed, int db, int sb, int pb, int to, int raw_mode) { - int tmp_ret = 0; + int tmp_ret = 0; - pthread_mutex_lock(&serial_a_parity_mutex); + pthread_mutex_lock(&serial_a_parity_mutex); - if (com_a_get_dev() < 0) { - pthread_mutex_unlock(&serial_a_parity_mutex); - return -1; - } + if (com_a_get_dev() < 0) { + pthread_mutex_unlock(&serial_a_parity_mutex); + return -1; + } - tmp_ret = com_set_opt(gSerialAHandle, speed, db, sb, pb, to, raw_mode); + tmp_ret = com_set_opt(gSerialAHandle, speed, db, sb, pb, to, raw_mode); - pthread_mutex_unlock(&serial_a_parity_mutex); + pthread_mutex_unlock(&serial_a_parity_mutex); - return tmp_ret; + return tmp_ret; } int com_b_set_opt(int speed, int db, int sb, int pb, int to, int raw_mode) { - int tmp_ret = 0; + int tmp_ret = 0; - pthread_mutex_lock(&serial_b_parity_mutex); + pthread_mutex_lock(&serial_b_parity_mutex); - if (com_b_get_dev() < 0) { - pthread_mutex_unlock(&serial_b_parity_mutex); - return -1; - } + if (com_b_get_dev() < 0) { + pthread_mutex_unlock(&serial_b_parity_mutex); + return -1; + } - tmp_ret = com_set_opt(gSerialBHandle, speed, db, sb, pb, to, raw_mode); + tmp_ret = com_set_opt(gSerialBHandle, speed, db, sb, pb, to, raw_mode); - pthread_mutex_unlock(&serial_b_parity_mutex); + pthread_mutex_unlock(&serial_b_parity_mutex); - return tmp_ret; + return tmp_ret; } int com_a_write_data(const unsigned char *pData, unsigned int uLen) { - int tmp_ret = 0; + int tmp_ret = 0; - pthread_mutex_lock(&serial_a_w_mutex); + pthread_mutex_lock(&serial_a_w_mutex); - if (com_a_get_dev() < 0) { - pthread_mutex_unlock(&serial_a_w_mutex); - return -1; - } + if (com_a_get_dev() < 0) { + pthread_mutex_unlock(&serial_a_w_mutex); + return -1; + } - LOGD("%s, write %d bytes\n", "TV", uLen); + LOGD("%s, write %d bytes\n", "TV", uLen); - tmp_ret = com_write_data(gSerialAHandle, pData, uLen); + tmp_ret = com_write_data(gSerialAHandle, pData, uLen); - pthread_mutex_unlock(&serial_a_w_mutex); + pthread_mutex_unlock(&serial_a_w_mutex); - return tmp_ret; + return tmp_ret; } int com_b_write_data(const unsigned char *pData, unsigned int uLen) { - int tmp_ret = 0; + int tmp_ret = 0; - pthread_mutex_lock(&serial_b_w_mutex); + pthread_mutex_lock(&serial_b_w_mutex); - if (com_b_get_dev() < 0) { - pthread_mutex_unlock(&serial_b_w_mutex); - return -1; - } + if (com_b_get_dev() < 0) { + pthread_mutex_unlock(&serial_b_w_mutex); + return -1; + } - LOGD("%s, write %d bytes\n", "TV", uLen); + LOGD("%s, write %d bytes\n", "TV", uLen); - tmp_ret = com_write_data(gSerialBHandle, pData, uLen); + tmp_ret = com_write_data(gSerialBHandle, pData, uLen); - pthread_mutex_unlock(&serial_b_w_mutex); + pthread_mutex_unlock(&serial_b_w_mutex); - return tmp_ret; + return tmp_ret; } int com_a_read_data(char *pData, unsigned int uLen) { - int tmp_ret = 0; + int tmp_ret = 0; - pthread_mutex_lock(&serial_a_r_mutex); + pthread_mutex_lock(&serial_a_r_mutex); - if (com_a_get_dev() < 0) { - pthread_mutex_unlock(&serial_a_r_mutex); - return -1; - } + if (com_a_get_dev() < 0) { + pthread_mutex_unlock(&serial_a_r_mutex); + return -1; + } - tmp_ret = com_read_data(gSerialAHandle, pData, uLen); + tmp_ret = com_read_data(gSerialAHandle, pData, uLen); - pthread_mutex_unlock(&serial_a_r_mutex); + pthread_mutex_unlock(&serial_a_r_mutex); - return tmp_ret; + return tmp_ret; } int com_b_read_data(char *pData, unsigned int uLen) { - int tmp_ret = 0; + int tmp_ret = 0; - pthread_mutex_lock(&serial_b_r_mutex); + pthread_mutex_lock(&serial_b_r_mutex); - if (com_b_get_dev() < 0) { - pthread_mutex_unlock(&serial_b_r_mutex); - return -1; - } + if (com_b_get_dev() < 0) { + pthread_mutex_unlock(&serial_b_r_mutex); + return -1; + } - tmp_ret = com_read_data(gSerialBHandle, pData, uLen); + tmp_ret = com_read_data(gSerialBHandle, pData, uLen); - pthread_mutex_unlock(&serial_b_r_mutex); + pthread_mutex_unlock(&serial_b_r_mutex); - return tmp_ret; + return tmp_ret; } |