mbtk/libgsw_lib/gsw_uart.c

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