guowenxue
2020-08-21 02f4d9518378031c63df7a36c49d8b2eabdaab90
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234
235
236
237
238
239
240
241
242
243
244
245
246
247
248
249
250
251
252
253
254
255
256
257
258
259
260
261
262
263
264
265
266
267
268
269
270
271
272
273
274
275
276
277
278
279
280
281
282
283
284
285
286
287
288
289
290
291
292
293
294
295
296
297
298
299
300
301
302
303
304
305
306
307
308
309
310
311
312
313
314
315
316
317
318
/*********************************************************************************
 *      Copyright:  (C) 2018 LingYun IoT System Studio
 *                  All rights reserved.
 *
 *       Filename:  sp2sck.c
 *    Description:  This file is the serial port to socket converter
 *                 
 *        Version:  1.0.0(2018年05月29日)
 *         Author:  Guo Wenxue <guowenxue@gmail.com>
 *      ChangeLog:  1, Release initial version on "2018年05月29日 21时03分54秒"
 *                 
 ********************************************************************************/
 
#include <libgen.h>
#include "cp_logger.h"
#include "cp_comport.h"
#include "cp_socket.h"
#include "cp_proc.h"
#include "sp2sck.h"
 
 
void *comport_worker(void *);
void *socket_worker(void *);
 
 
/* Show program version information, can used by 'sp2sck --version or sp2sck -v'*/
static inline void prog_version(const char *progname)
{
    printf("%s Version 1.0.0 Build(%s)\n", progname, __DATE__);
    return ;
}
 
 
/* Show program help information, can used by 'sp2sck --help or sp2sck -h'*/
static void prog_usage(const char *progname)
{
    prog_version(progname);
    
    printf("Usage: %s [OPTION]...\n", progname);
    printf("Receive date from a serial port and transfer the data to remote server by socket.\n");
    printf("\nMandatory arguments to long options are mandatory for short options too:\n");
 
    printf(" -d[debug   ]  Running in debug mode\n");
    printf(" -l[level   ]  Set the log level as [0..%d]\n", LOG_LEVEL_MAX-1);
    printf(" -c[comport ]  Serial port device, default as /dev/ttyS1.\n");
    printf(" -b[baudrate]  Baudrate, default as 115200.\n");
    printf(" -s[server  ]  Socket connect server host and port, format as: Hostname:Port, default as 127.0.0.1:8900\n");
 
    printf(" -v[version ]  Display program version\n");
    printf(" -h[help    ]  Display this help information\n");
    return ;
}
 
 
int main (int argc, char **argv)
{
    const char             *progname=NULL;
 
    int                    opt;
    int                    debug = 0;            /* program running information log to stdard output */
    char                   pid_file[64] = { 0 }; /*   The file used to record the PID */
    int                    log_level = LOG_LEVEL_TRACE;  /* program running information log to file level  */
    cp_logger             *logger;
    char                  *log_file="sp2sck.log";        /* program running information log file name  */
 
    char                  *devname = "/dev/ttyS1";      /* default serial port, can use '-c' option to change */
    unsigned long          baudrate = 115200;           /* default serial port baudrate, can use '-b' option to change */
    char                  *server="127.0.0.1:8900";    /* default connect server address, can use '-s' option to change */
 
 
    sp2sck_ctx_t           ctx;
    int                    rv;
    pthread_t              tid;
 
    memset(&ctx, 0, sizeof(ctx));
 
    /* progranm command options  */
    struct option long_options[] = { 
        {"debug", no_argument, NULL, 'd'},          /* sp2sck -d or sp2sck --debug, log to standard output or not */
        {"level", required_argument, NULL, 'l'},    /* sp2sck -l 7, specify log to file level */
        {"comport", required_argument, NULL, 'c'},  /* sp2sck -c /dev/ttyUSB0, specify serial port device name */
        {"baudrate", required_argument, NULL, 'b'}, /* sp2sck -b 115200, specify serial port baudrate  */
        {"server", required_argument, NULL, 's'},   /* sp2sck -s 192.168.0.5:9999, specify server address and port */
        {"version", no_argument, NULL, 'v'},        /* sp2sck -v or sp2sck --version to check program version information */
        {"help", no_argument, NULL, 'h'},           /* sp2sck -h or sp2sck --help to get program help information  */
        {NULL, 0, NULL, 0}                          /* array end flag */
    }; 
 
 
    progname = basename(argv[0]);
 
 
    /* Parser the command line options */
    while ((opt = getopt_long(argc, argv, "c:b:s:dl:vh", long_options, NULL)) != -1)
    {
        switch (opt)
        {
            case 'c':  /* sp2sck -c /dev/ttyUSB0 */
                devname = optarg;
                break;
 
            case 'b':  /* sp2sck -b 115200 */
                baudrate = atol(optarg);
                break;
 
            case 's': /*  sp2sck -s 192.168.0.5:9999 */
                server=optarg;
                break;
 
            case 'd': /* sp2sck -d or sp2sck --debug */
                debug = 1;
                log_file = DBG_LOG_FILE;
                break;
 
            case 'l': /* sp2sck -l 7 */
                rv = atoi(optarg);
                log_level = rv>LOG_LEVEL_MAX ? LOG_LEVEL_MAX-1 : rv;
                break;
 
            case 'v':  /* sp2sck -v */
                prog_version(progname); 
                return EXIT_SUCCESS;
 
            case 'h':  /* sp2sck -h */
                prog_usage(progname);
                return 0;
 
            default:
                break;
        } /*  end of "switch(opt)" */
    }
 
 
 
    /* parser hostname and port by server*/
    {
        char       *ptr;
 
        ptr=strchr(server, ':');
        if( !ptr )
        {
            printf("Invalid server host[%s], which format should be [HostName:Port] such as \"127.0.0.1:8900\"", server);
            return -1;
        }
 
        strncpy(ctx.hostname, server, ptr-server);
        ctx.port = atoi(&ptr[1]);
    }
 
    printf("Serial[%s] and server[%s:%d] converter start\n", devname, ctx.hostname, ctx.port);
    
 
    /* check program already running on background or not */
    if( !debug )
    {   
        snprintf(pid_file, sizeof(pid_file), "/var/run/%s.pid", progname);
        if( check_daemon_running(pid_file) )
        {   
            printf("Programe already running, exit now.\n");
            return -1; 
        }   
    }
    
    
    /* initialise logger system  */
    if( !(logger=cp_log_init(NULL, log_file, log_level, 0)) || cp_log_open()<0  )
    {
        printf("Init logger system failed, program exit now...\n");
        return -1;
    }
    log_nrml("Serial[%s] and server[%s] converter start\n", devname, server);
 
    if( NULL == (ctx.comport=comport_init(devname, baudrate, "8N1N")) )
    {
        log_err("initial serial port failure\n");
        return -1;
    }
 
    /* set program running in background */
    if( !debug )
    {
        if( set_daemon_running(pid_file) )
        {
            log_fatal("Set program \"%s\" running as daemon failure.\n", progname);
            return -2;
        }
    }
 
    /* install signal process handler  */
    cp_install_proc_signal();
 
 
    /* start serial port data process thread */
    thread_start(&tid, comport_worker, &ctx); 
    
    
    /* start socket data process thread */
    thread_start(&tid, socket_worker, &ctx);
 
 
    while( !g_cp_signal.stop )
    {
        /* control/main thread do nothing here  */
        sleep(1);
    }
 
    return 0;
 
 
void *comport_worker(void *arg)
{
    sp2sck_ctx_t          *ctx = (sp2sck_ctx_t *)arg;
    cp_comport_t          *comport;
    cp_socket_t           *socket;
    char                   buf[1024];
    int                    rv = 0;
 
    if( !ctx ) 
    {
        log_err("Invalid arguments\n");
        return NULL;
    }
 
    comport = ctx->comport;
    socket = &ctx->socket;
 
    log_nrml("Thread worker for comport start\n");
 
    while( !g_cp_signal.stop )
    {
        if( ctx->comport->connected )
        {
            rv=comport_open(ctx->comport);
            if( 0 == rv )
                log_nrml("open serial port \"%s\" successfully\n", ctx->comport->dev_name);
            else 
                log_err("open serial port \"%s\" failure, rv=%d\n", ctx->comport->dev_name, rv);
        }
 
 
        if( !comport->connected || SOCK_STAT_CONNECTED != socket->status )
        {
            continue; 
        }
 
        rv=comport_recv(comport, buf, sizeof(buf), 1000);
        if( rv > 0 )
        {
            log_nrml("Recive %d bytes data from comport[%s] and will write to socket[%s:%d]\n", 
                    rv, comport->dev_name, socket->servaddr, socket->servport);
            cp_log_dump(LOG_LEVEL_DEBUG, buf, rv);
 
            write(socket->fd, buf, rv);
        }
    }
 
    return NULL;
}
 
 
void *socket_worker(void *arg)
{
    sp2sck_ctx_t          *ctx = (sp2sck_ctx_t *)arg;
    cp_comport_t          *comport;
    cp_socket_t           *socket;
    char                   buf[1024];
    int                    rv = 0;
    
 
    if( !ctx ) 
    {
        log_err("Invalid arguments\n");
        return NULL;
    }
 
    comport = ctx->comport;
    socket = &ctx->socket;
 
    log_nrml("Thread worker for socket start\n");
 
    while( !g_cp_signal.stop )
    {
 
        if( SOCK_STAT_CONNECTED != ctx->socket.status )
        {
            printf("start block connect\n");
            rv=cp_sock_block_connect(&ctx->socket, ctx->hostname, ctx->port);
            if( rv<0 )
                log_err("connect to server [%s:%d] return rv=%d\n", ctx->socket.servaddr, ctx->socket.servport, rv);
            else 
                log_nrml("connect to server [%s:%d] successfully\n", ctx->socket.servaddr, ctx->socket.servport);
        }
 
 
        if( !comport->connected ||  SOCK_STAT_CONNECTED != socket->status )
        {
            continue; 
        }
 
        rv=read(socket->fd, buf, sizeof(buf));
        if( rv > 0 )
        {
            log_nrml("Recive %d bytes data from socket[%s:%d] and will write to comport[%s]\n", 
                    rv, socket->servaddr, socket->servport, comport->dev_name);
            cp_log_dump(LOG_LEVEL_DEBUG, buf, rv);
 
            comport_send(comport, buf, rv);
        }
        else if( 0==rv )
        {
            log_warn("Remove socket server disconnect\n");
            socket->status = SOCK_STAT_DISCONNECT;
        }
    }
 
    return NULL;
}