Fix mbtk from v1265 GSW
Change-Id: I5d8d395616f284bc74c8b9448cfa347164b5a668
diff --git a/mbtk/libgsw_lib/gsw_uart.c b/mbtk/libgsw_lib/gsw_uart.c
new file mode 100755
index 0000000..5b9738c
--- /dev/null
+++ b/mbtk/libgsw_lib/gsw_uart.c
@@ -0,0 +1,388 @@
+#include <stdio.h>
+#include <stdlib.h>
+#include <fcntl.h>
+#include <sys/types.h>
+#include <sys/stat.h>
+#include <string.h>
+#include <errno.h>
+#include <termios.h>
+#include <unistd.h>
+#include <stdint.h>
+#include <sys/ioctl.h>
+#include <dlfcn.h>
+
+#include "gsw_uart.h"
+
+#ifndef LOG_ERR_LEVEL
+#define LOG_ERR_LEVEL 3 /* error conditions */
+#endif
+#ifndef LOG_WARN_LEVEL
+#define LOG_WARN_LEVEL 4 /* warning conditions */
+#endif
+#ifndef LOG_INFO_LEVEL
+#define LOG_INFO_LEVEL 6 /* informational */
+#endif
+#ifndef LOG_DEBUG_LEVEL
+#define LOG_DEBUG_LEVEL 7 /* debug-level messages */
+#endif
+#ifndef LOG_VERBOSE_LEVEL
+#define LOG_VERBOSE_LEVEL 8
+#endif
+
+#define LOGV(fmt, args ...) \
+ do{ \
+ char *file_ptr_1001 = __FILE__; \
+ char *ptr_1001 = file_ptr_1001 + strlen(file_ptr_1001) - 1; \
+ char line_1001[10] = {0}; \
+ sprintf(line_1001, "%d", __LINE__); \
+ while(ptr_1001 >= file_ptr_1001 && *ptr_1001){ \
+ if(*ptr_1001 == '/') \
+ break; \
+ ptr_1001--; \
+ } \
+ fun_ptr_log(LOG_VERBOSE_LEVEL, "%s#%s: " fmt, ptr_1001 + 1, line_1001, ##args); \
+ } while(0)
+
+#define LOGI(fmt, args...) \
+ do{ \
+ char *file_ptr_1001 = __FILE__; \
+ char *ptr_1001 = file_ptr_1001 + strlen(file_ptr_1001) - 1; \
+ char line_1001[10] = {0}; \
+ sprintf(line_1001, "%d", __LINE__); \
+ while(ptr_1001 >= file_ptr_1001 && *ptr_1001){ \
+ if(*ptr_1001 == '/') \
+ break; \
+ ptr_1001--; \
+ } \
+ fun_ptr_log(LOG_INFO_LEVEL, "%s#%s: " fmt, ptr_1001 + 1, line_1001, ##args); \
+ } while(0)
+
+#define LOGD(fmt, args...) \
+ do{ \
+ char *file_ptr_1001 = __FILE__; \
+ char *ptr_1001 = file_ptr_1001 + strlen(file_ptr_1001) - 1; \
+ char line_1001[10] = {0}; \
+ sprintf(line_1001, "%d", __LINE__); \
+ while(ptr_1001 >= file_ptr_1001 && *ptr_1001){ \
+ if(*ptr_1001 == '/') \
+ break; \
+ ptr_1001--; \
+ } \
+ fun_ptr_log(LOG_DEBUG_LEVEL, "%s#%s: " fmt, ptr_1001 + 1, line_1001, ##args); \
+ } while(0)
+
+#define LOGW(fmt, args...) \
+ do{ \
+ char *file_ptr_1001 = __FILE__; \
+ char *ptr_1001 = file_ptr_1001 + strlen(file_ptr_1001) - 1; \
+ char line_1001[10] = {0}; \
+ sprintf(line_1001, "%d", __LINE__); \
+ while(ptr_1001 >= file_ptr_1001 && *ptr_1001){ \
+ if(*ptr_1001 == '/') \
+ break; \
+ ptr_1001--; \
+ } \
+ fun_ptr_log(LOG_WARN_LEVEL, "%s#%s: " fmt, ptr_1001 + 1, line_1001, ##args); \
+ } while(0)
+
+#define LOGE(fmt, args...) \
+ do{ \
+ char *file_ptr_1001 = __FILE__; \
+ char *ptr_1001 = file_ptr_1001 + strlen(file_ptr_1001) - 1; \
+ char line_1001[10] = {0}; \
+ sprintf(line_1001, "%d", __LINE__); \
+ while(ptr_1001 >= file_ptr_1001 && *ptr_1001){ \
+ if(*ptr_1001 == '/') \
+ break; \
+ ptr_1001--; \
+ } \
+ fun_ptr_log(LOG_ERR_LEVEL, "%s#%s: " fmt, ptr_1001 + 1, line_1001, ##args); \
+ } while(0)
+
+typedef void (*mbtk_log)(int level, const char *format,...);
+static mbtk_log fun_ptr_log = NULL;
+void *dlHandle_uart = NULL;
+char *lynqLib_uart = "/lib/libmbtk_lib.so";
+
+static int handle()
+{
+ if(dlHandle_uart == NULL || fun_ptr_log == NULL)
+ {
+ dlHandle_uart = dlopen(lynqLib_uart, RTLD_NOW);
+ fun_ptr_log = (mbtk_log)dlsym(dlHandle_uart, "mbtk_log");
+ if(fun_ptr_log == NULL || dlHandle_uart == NULL)
+ {
+ return GSW_HAL_FAIL;
+ }
+ }
+ return GSW_HAL_SUCCESS;
+}
+
+
+
+
+int32_t gsw_uart_open_ex(int8_t *port, gsw_hal_uart_baudrate baudrate, uint32_t bits, int8_t parity, uint32_t stop)
+{
+ if (handle())
+ return GSW_HAL_FAIL;
+ int fd = -1;
+ if((fd = open((const char *)port, O_RDWR | O_NOCTTY | O_NONBLOCK)) < 0)
+ {
+ LOGE("open %s failed - %d", port, errno);
+ return -1;
+ }
+ LOGD("Open %s success.", port);
+
+ /* set newtio */
+ struct termios newtio;
+ memset(&newtio, 0, sizeof(newtio));
+ if (tcflush(fd, TCIOFLUSH) < 0) {
+ LOGE("Could not flush uart port");
+ return -1;
+ }
+
+ newtio.c_cc[VTIME] = 0; /* inter-character timer unused */
+ newtio.c_cc[VMIN] = 0; /* blocking read until 5 chars received */
+
+ /* c_iflag 输入模式 */
+ newtio.c_iflag &= ~(ICRNL | INLCR);
+ newtio.c_iflag &= ~(IXON | IXOFF | IXANY);
+
+ // /* c_lflag 本地模式 */
+ newtio.c_cflag &= ~ INPCK;
+ newtio.c_cflag |= (CLOCAL | CREAD);
+
+ // /* c_lflag 本地模式 */
+ newtio.c_lflag &= ~(ICANON | ECHO | ECHOE | ISIG);
+ /* c_oflag 输出模式 */
+ newtio.c_oflag &= ~ OPOST;
+ newtio.c_oflag &= ~(ONLCR | OCRNL);
+
+ /* c_cflag 控制模式 */
+ newtio.c_cflag &= ~ CSIZE;
+ newtio.c_cflag |= CS8;
+ newtio.c_cflag &= ~ CSTOPB;
+ newtio.c_cflag &= ~ PARENB;
+
+
+ switch(baudrate)
+ {
+ case GSW_HAL_BAUDRATE_1200:
+ cfsetospeed(&newtio, B1200);
+ cfsetispeed(&newtio, B1200);
+ break;
+ case GSW_HAL_BAUDRATE_1800:
+ cfsetospeed(&newtio, B1800);
+ cfsetispeed(&newtio, B1800);
+ break;
+ case GSW_HAL_BAUDRATE_4800:
+ cfsetospeed(&newtio, B4800);
+ cfsetispeed(&newtio, B4800);
+ break;
+ case GSW_HAL_BAUDRATE_9600:
+ cfsetospeed(&newtio, B9600);
+ cfsetispeed(&newtio, B9600);
+ break;
+ case GSW_HAL_BAUDRATE_19200:
+ cfsetospeed(&newtio, B19200);
+ cfsetispeed(&newtio, B19200);
+ break;
+ case GSW_HAL_BAUDRATE_38400:
+ cfsetospeed(&newtio, B38400);
+ cfsetispeed(&newtio, B38400);
+ break;
+ case GSW_HAL_BAUDRATE_57600:
+ cfsetospeed(&newtio, B57600);
+ cfsetispeed(&newtio, B57600);
+ break;
+ case GSW_HAL_BAUDRATE_115200:
+ cfsetospeed(&newtio, B115200);
+ cfsetispeed(&newtio, B115200);
+ break;
+ case GSW_HAL_BAUDRATE_230400:
+ cfsetospeed(&newtio, B230400);
+ cfsetispeed(&newtio, B230400);
+ break;
+ case GSW_HAL_BAUDRATE_460800:
+ cfsetospeed(&newtio, B460800);
+ cfsetispeed(&newtio, B460800);
+ break;
+ case GSW_HAL_BAUDRATE_500000:
+ cfsetospeed(&newtio, B500000);
+ cfsetispeed(&newtio, B500000);
+ break;
+ case GSW_HAL_BAUDRATE_576000:
+ cfsetospeed(&newtio, B576000);
+ cfsetispeed(&newtio, B576000);
+ break;
+ case GSW_HAL_BAUDRATE_921600:
+ cfsetospeed(&newtio, B921600);
+ cfsetispeed(&newtio, B921600);
+ break;
+ default:
+ cfsetospeed(&newtio, B115200);
+ cfsetispeed(&newtio, B115200);
+ break;
+ }
+
+ switch(bits)
+ {
+ case CS5:
+ newtio.c_cflag &= ~CSIZE;
+ newtio.c_cflag |= CS5;
+ break;
+ case CS6:
+ newtio.c_cflag &= ~CSIZE;
+ newtio.c_cflag |= CS6;
+ break;
+ case CS7:
+ newtio.c_cflag &= ~CSIZE;
+ newtio.c_cflag |= CS7;
+ break;
+ case CS8:
+ newtio.c_cflag &= ~CSIZE;
+ newtio.c_cflag |= CS8;
+ break;
+ default:
+ LOGD("No set databit.");
+ break;
+ }
+
+ if(stop == 2) {
+ newtio.c_cflag |= CSTOPB;
+ } else {
+ newtio.c_cflag &= ~CSTOPB;
+ }
+
+ switch (parity)
+ {
+ case '1':// 奇校验
+ newtio.c_cflag |= PARENB;
+ newtio.c_cflag |= PARODD;
+ break;
+ case '2':// 偶校验
+ newtio.c_cflag |= PARENB;
+ newtio.c_cflag &= ~PARODD;
+ break;
+ case '0':// 无奇偶校验
+ newtio.c_cflag &= ~PARENB;
+ break;
+ default:
+ LOGD("No set parity.");
+ break;
+ }
+
+ if (tcsetattr(fd, TCSANOW, &newtio) < 0) {
+ LOGE("Can't set port setting");
+ return -1;
+ }
+
+ return fd;
+}
+
+int32_t gsw_uart_flush(int32_t fd)
+{
+ if (tcflush(fd, TCIOFLUSH) < 0)
+ {
+ return GSW_HAL_FAIL;
+ }
+ return GSW_HAL_SUCCESS;
+}
+
+
+int32_t gsw_uart_read(int32_t fd, uint8_t *buffer, uint32_t len, int32_t timeout_ms)
+{
+ if (handle())
+ return GSW_HAL_FAIL;
+ int flags = fcntl(fd, F_GETFL); // 获取当前状态标志
+ if (flags == -1)
+ {
+ perror("fcntl get");
+ return GSW_HAL_FAIL;
+ }
+
+ struct termios newtio;
+ if (tcgetattr(fd, &newtio) < 0) {
+ perror("tcgetattr failed");
+ return -1;
+ }
+ if (timeout_ms == 0)
+ {
+ flags |= O_NONBLOCK; // 设置非阻塞标志
+ fcntl(fd, F_SETFL, flags);
+ newtio.c_cc[VMIN] = 0;
+ newtio.c_cc[VTIME] = 0;
+ }
+ else if (timeout_ms == 1)
+ {
+ flags &= ~O_NONBLOCK; // 清除非阻塞标志
+ fcntl(fd, F_SETFL, flags);
+ newtio.c_cc[VMIN] = 1;
+ newtio.c_cc[VTIME] = timeout_ms/100;
+ }
+ else
+ {
+ flags &= ~O_NONBLOCK; // 清除非阻塞标志
+ fcntl(fd, F_SETFL, flags);
+ newtio.c_cc[VMIN] = 0;
+ newtio.c_cc[VTIME] = timeout_ms/100;
+ }
+ if(timeout_ms != 0)
+ LOGI("%s :VMIN = %d ;VTIME = %d\n",__func__,newtio.c_cc[VMIN],newtio.c_cc[VTIME]);
+ if (tcsetattr(fd, TCSANOW, &newtio) != 0)
+ {
+ perror("tcsetattr");
+ return -1;
+ }
+ //gsw_uart_flush(fd);
+ int data_len = read(fd, buffer, len);
+ if (data_len < 0)
+ {
+ if(errno == EAGAIN || errno == EWOULDBLOCK)
+ return 0;
+ else
+ return GSW_HAL_FAIL;
+ }
+ return data_len;
+}
+
+
+int32_t gsw_uart_write(int32_t fd, const uint8_t *buffer, uint32_t len)
+{
+ //gsw_uart_flush(fd);
+ if (write(fd, buffer, len) < 0)
+ {
+ return GSW_HAL_FAIL;
+ }
+ return GSW_HAL_SUCCESS;
+}
+
+int32_t gsw_uart_ioctl(int32_t fd, uint32_t cmd, void *pvalue)
+{
+ if (handle())
+ return GSW_HAL_FAIL;
+ if (fd < 0 || pvalue == NULL)
+ {
+ LOGE("Invalid file descriptor");
+ return GSW_HAL_FAIL;
+ }
+ if (ioctl(fd, cmd, pvalue) < 0)
+ {
+ LOGE("Could not set DCB,error:%d, %s\n",errno, strerror(errno));
+ return GSW_HAL_FAIL;
+ }
+ return GSW_HAL_SUCCESS;
+}
+
+
+
+
+int32_t gsw_uart_close(int32_t fd)
+{
+ if (fd <= 0)
+ return GSW_HAL_FAIL;
+ //gsw_uart_flush(fd);
+ close(fd);
+ return GSW_HAL_SUCCESS;
+}
+