| 123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729 |
- /*
- * File : at_client.c
- * This file is part of RT-Thread RTOS
- * COPYRIGHT (C) 2006 - 2018, RT-Thread Development Team
- *
- * This program is free software; you can redistribute it and/or modify
- * it under the terms of the GNU General Public License as published by
- * the Free Software Foundation; either version 2 of the License, or
- * (at your option) any later version.
- *
- * This program is distributed in the hope that it will be useful,
- * but WITHOUT ANY WARRANTY; without even the implied warranty of
- * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
- * GNU General Public License for more details.
- *
- * You should have received a copy of the GNU General Public License along
- * with this program; if not, write to the Free Software Foundation, Inc.,
- * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
- *
- * Change Logs:
- * Date Author Notes
- * 2018-03-30 chenyong first version
- * 2018-04-12 chenyong add client implement
- */
- #include <at.h>
- #include <stdio.h>
- #include <stdlib.h>
- #include <string.h>
- #define AT_RESP_END_OK "OK"
- #define AT_RESP_END_ERROR "ERROR"
- #define AT_RESP_END_FAIL "FAIL"
- #define AT_END_CR_LF "\r\n"
- static at_client_t at_client_local = RT_NULL;
- static char cust_end_sign = 0;
- extern rt_size_t at_vprintfln(rt_device_t device, const char *format, va_list args);
- extern void at_print_raw_cmd(const char *type, const char *cmd, rt_size_t size);
- extern const char *at_get_last_cmd(rt_size_t *cmd_size);
- /**
- * Create response structure.
- *
- * @param buf_size the maximum response buffer size
- * @param line_num the number of setting response lines
- * = 0: the response data will auto return when received 'OK' or 'ERROR'
- * != 0: the response data will return when received setting lines number data
- * @param timeout the maximum response time
- *
- * @return != RT_NULL: response structure
- * = RT_NULL: no memory
- */
- at_response_t at_create_resp(rt_size_t buf_size, rt_size_t line_num, rt_int32_t timeout)
- {
- at_response_t resp = RT_NULL;
- resp = (at_response_t) rt_calloc(1, sizeof(struct at_response));
- if (!resp)
- {
- LOG_E("AT create response structure failed! No memory for response structure!");
- return RT_NULL;
- }
- resp->buf = (char *) rt_calloc(1, buf_size);
- if (!resp->buf)
- {
- LOG_E("AT create response structure failed! No memory for response buf structure!");
- rt_free(resp);
- return RT_NULL;
- }
- resp->buf_size = buf_size;
- resp->line_num = line_num;
- resp->line_counts = 0;
- resp->timeout = timeout;
- return resp;
- }
- /**
- * Delete and free response structure.
- *
- * @param resp response structure
- */
- void at_delete_resp(at_response_t resp)
- {
- if (resp && resp->buf)
- {
- rt_free(resp->buf);
- }
- if (resp)
- {
- rt_free(resp);
- resp = RT_NULL;
- }
- }
- /**
- * Set response structure information
- *
- * @param resp response structure
- * @param buf_size the maximum response buffer size
- * @param line_num the number of setting response lines
- * = 0: the response data will auto return when received 'OK' or 'ERROR'
- * != 0: the response data will return when received setting lines number data
- * @param timeout the maximum response time
- *
- * @return != RT_NULL: response structure
- * = RT_NULL: no memory
- */
- at_response_t at_resp_set_info(at_response_t resp, rt_size_t buf_size, rt_size_t line_num, rt_int32_t timeout)
- {
- RT_ASSERT(resp);
- if(resp->buf_size != buf_size)
- {
- resp->buf_size = buf_size;
- resp->buf = rt_realloc(resp->buf, buf_size);
- if(!resp->buf)
- {
- LOG_D("No memory for realloc response buffer size(%d).", buf_size);
- return RT_NULL;
- }
- }
- resp->line_num = line_num;
- resp->timeout = timeout;
- return resp;
- }
- /**
- * Get one line AT response buffer by line number.
- *
- * @param resp response structure
- * @param resp_line line number, start from '1'
- *
- * @return != RT_NULL: response line buffer
- * = RT_NULL: input response line error
- */
- const char *at_resp_get_line(at_response_t resp, rt_size_t resp_line)
- {
- char *resp_buf = resp->buf;
- char *resp_line_buf = RT_NULL;
- rt_size_t line_num = 1;
- RT_ASSERT(resp);
- if (resp_line > resp->line_counts || resp_line <= 0)
- {
- LOG_E("AT response get line failed! Input response line(%d) error!", resp_line);
- return RT_NULL;
- }
- for (line_num = 1; line_num <= resp->line_counts; line_num++)
- {
- if (resp_line == line_num)
- {
- resp_line_buf = resp_buf;
- return resp_line_buf;
- }
- resp_buf += strlen(resp_buf) + 1;
- }
- return RT_NULL;
- }
- /**
- * Get one line AT response buffer by keyword
- *
- * @param resp response structure
- * @param keyword query keyword
- *
- * @return != RT_NULL: response line buffer
- * = RT_NULL: no matching data
- */
- const char *at_resp_get_line_by_kw(at_response_t resp, const char *keyword)
- {
- char *resp_buf = resp->buf;
- char *resp_line_buf = RT_NULL;
- rt_size_t line_num = 1;
- RT_ASSERT(resp);
- RT_ASSERT(keyword);
- for (line_num = 1; line_num <= resp->line_counts; line_num++)
- {
- if(strstr(resp_buf, keyword))
- {
- resp_line_buf = resp_buf;
- return resp_line_buf;
- }
- resp_buf += strlen(resp_buf) + 1;
- }
- return RT_NULL;
- }
- /**
- * Get and parse AT response buffer arguments by line number.
- *
- * @param resp response structure
- * @param resp_line line number, start from '1'
- * @param resp_expr response buffer expression
- *
- * @return -1 : input response line number error or get line buffer error
- * 0 : parsed without match
- * >0 : the number of arguments successfully parsed
- */
- int at_resp_parse_line_args(at_response_t resp, rt_size_t resp_line, const char *resp_expr, ...)
- {
- va_list args;
- int resp_args_num = 0;
- const char *resp_line_buf = RT_NULL;
- RT_ASSERT(resp);
- RT_ASSERT(resp_expr);
- if ((resp_line_buf = at_resp_get_line(resp, resp_line)) == RT_NULL)
- {
- return -1;
- }
- va_start(args, resp_expr);
- resp_args_num = vsscanf(resp_line_buf, resp_expr, args);
- va_end(args);
- return resp_args_num;
- }
- /**
- * Get and parse AT response buffer arguments by keyword.
- *
- * @param resp response structure
- * @param keyword query keyword
- * @param resp_expr response buffer expression
- *
- * @return -1 : input keyword error or get line buffer error
- * 0 : parsed without match
- * >0 : the number of arguments successfully parsed
- */
- int at_resp_parse_line_args_by_kw(at_response_t resp, const char *keyword, const char *resp_expr, ...)
- {
- va_list args;
- int resp_args_num = 0;
- const char *resp_line_buf = RT_NULL;
- RT_ASSERT(resp);
- RT_ASSERT(resp_expr);
- if ((resp_line_buf = at_resp_get_line_by_kw(resp, keyword)) == RT_NULL)
- {
- return -1;
- }
- va_start(args, resp_expr);
- resp_args_num = vsscanf(resp_line_buf, resp_expr, args);
- va_end(args);
- return resp_args_num;
- }
- /**
- * Send commands to AT server and wait response.
- *
- * @param resp AT response structure, using RT_NULL when you don't care response
- * @param cmd_expr AT commands expression
- *
- * @return 0 : success
- * -1 : response status error
- * -2 : wait timeout
- */
- int at_exec_cmd(at_response_t resp, const char *cmd_expr, ...)
- {
- at_client_t client = at_client_local;
- va_list args;
- rt_size_t cmd_size = 0;
- rt_err_t result = RT_EOK;
- const char *cmd = RT_NULL;
- RT_ASSERT(cmd_expr);
- rt_mutex_take(client->lock, RT_WAITING_FOREVER);
- client->resp_status = AT_RESP_OK;
- client->resp = resp;
- va_start(args, cmd_expr);
- at_vprintfln(client->device, cmd_expr, args);
- va_end(args);
- if (resp)
- {
- resp->line_counts = 0;
- if (rt_sem_take(client->resp_notice, resp->timeout) != RT_EOK)
- {
- cmd = at_get_last_cmd(&cmd_size);
- LOG_E("execute command (%.*s) timeout (%d ticks)!", cmd_size, cmd, resp->timeout);
- client->resp_status = AT_RESP_TIMEOUT;
- result = -RT_ETIMEOUT;
- goto __exit;
- }
- if (client->resp_status != AT_RESP_OK)
- {
- cmd = at_get_last_cmd(&cmd_size);
- LOG_E("execute command (%.*s) failed!", cmd_size, cmd);
- result = -RT_ERROR;
- goto __exit;
- }
- }
- __exit:
- client->resp = RT_NULL;
- rt_mutex_release(client->lock);
- return result;
- }
- /**
- * Send data to AT server, send data don't have end sign(eg: \r\n).
- *
- * @param buf send data buffer
- * @param size send fixed data size
- *
- * @return send data size
- */
- rt_size_t at_client_send(const char *buf, rt_size_t size)
- {
- at_client_t client = at_client_local;
- RT_ASSERT(buf);
- #ifdef AT_PRINT_RAW_CMD
- at_print_raw_cmd("send", buf, size);
- #endif
- return rt_device_write(client->device, 0, buf, size);
- }
- static char at_client_getchar(void)
- {
- char ch;
- while (rt_device_read(at_client_local->device, 0, &ch, 1) == 0)
- {
- rt_sem_control(at_client_local->rx_notice, RT_IPC_CMD_RESET, RT_NULL);
- rt_sem_take(at_client_local->rx_notice, RT_WAITING_FOREVER);
- }
- return ch;
- }
- /**
- * AT client receive fixed-length data.
- *
- * @param buf receive data buffer
- * @param size receive fixed data size
- *
- * @note this function can only be used in execution function of URC data
- *
- * @return success receive data size
- */
- rt_size_t at_client_recv(char *buf, rt_size_t size)
- {
- rt_size_t read_idx = 0;
- char ch;
- RT_ASSERT(buf);
- while (1)
- {
- if (read_idx < size)
- {
- ch = at_client_getchar();
- buf[read_idx++] = ch;
- }
- else
- {
- break;
- }
- }
- #ifdef AT_PRINT_RAW_CMD
- at_print_raw_cmd("urc_recv", buf, size);
- #endif
- return read_idx;
- }
- /**
- * get AT client structure pointer.
- *
- * @return AT client structure pointer
- */
- at_client_t rt_at_get_client(void)
- {
- RT_ASSERT(at_client_local);
- RT_ASSERT(at_client_local->status != AT_STATUS_UNINITIALIZED);
- return at_client_local;
- }
- /**
- * AT client set end sign.
- *
- * @param ch the end sign, can not be used when it is '\0'
- *
- * @return 0: set success
- */
- int at_set_end_sign(char ch)
- {
- cust_end_sign = ch;
- return 0;
- }
- static const struct at_urc *get_urc_obj(char *data, rt_size_t size)
- {
- rt_size_t i, prefix_len, suffix_len;
- at_client_t client = at_client_local;
- if (client->urc_table == RT_NULL)
- {
- return RT_NULL;
- }
- for (i = 0; i < client->urc_table_size; i++)
- {
- prefix_len = strlen(client->urc_table[i].cmd_prefix);
- suffix_len = strlen(client->urc_table[i].cmd_suffix);
- if (size < prefix_len + suffix_len)
- {
- continue;
- }
- if ((prefix_len ? !strncmp(data, client->urc_table[i].cmd_prefix, prefix_len) : 1)
- && (suffix_len ? !strncmp(data + size - suffix_len, client->urc_table[i].cmd_suffix, suffix_len) : 1))
- {
- return &client->urc_table[i];
- }
- }
- return RT_NULL;
- }
- static int at_recv_readline(void)
- {
- rt_size_t read_len = 0;
- char ch = 0, last_ch = 0;
- rt_bool_t is_full = RT_FALSE;
- at_client_t client = at_client_local;
- memset(client->recv_buffer, 0x00, AT_CLIENT_RECV_BUFF_LEN);
- client->cur_recv_len = 0;
- while (1)
- {
- ch = at_client_getchar();
- if (read_len < AT_CLIENT_RECV_BUFF_LEN)
- {
- client->recv_buffer[read_len++] = ch;
- }
- else
- {
- is_full = RT_TRUE;
- }
- /* is newline or URC data */
- if ((ch == '\n' && last_ch == '\r') || (cust_end_sign != 0 && ch == cust_end_sign)
- || get_urc_obj(client->recv_buffer, read_len))
- {
- if (is_full)
- {
- LOG_E("read line failed. The line data length is out of buffer size(%d)!", AT_CLIENT_RECV_BUFF_LEN);
- memset(client->recv_buffer, 0x00, AT_CLIENT_RECV_BUFF_LEN);
- client->cur_recv_len = 0;
- return -RT_EFULL;
- }
- client->cur_recv_len = read_len;
- break;
- }
- last_ch = ch;
- }
- #ifdef AT_PRINT_RAW_CMD
- at_print_raw_cmd("recvline", client->recv_buffer, read_len);
- #endif
- return read_len;
- }
- static void client_parser(at_client_t client)
- {
- int resp_buf_len = 0;
- const struct at_urc *urc;
- rt_size_t line_counts = 0;
- while(1)
- {
- if (at_recv_readline() > 0)
- {
- if ((urc = get_urc_obj(client->recv_buffer, client->cur_recv_len)) != RT_NULL)
- {
- /* current receive is request, try to execute related operations */
- if (urc->func != RT_NULL)
- {
- urc->func(client->recv_buffer, client->cur_recv_len);
- }
- }
- else if (client->resp != RT_NULL)
- {
- /* current receive is response */
- client->recv_buffer[client->cur_recv_len - 1] = '\0';
- if (resp_buf_len + client->cur_recv_len < client->resp->buf_size)
- {
- /* copy response lines, separated by '\0' */
- memcpy(client->resp->buf + resp_buf_len, client->recv_buffer, client->cur_recv_len);
- resp_buf_len += client->cur_recv_len;
- line_counts++;
- }
- else
- {
- client->resp_status = AT_RESP_BUFF_FULL;
- LOG_E("Read response buffer failed. The Response buffer size is out of buffer size(%d)!", client->resp->buf_size);
- }
- /* check response result */
- if (memcmp(client->recv_buffer, AT_RESP_END_OK, strlen(AT_RESP_END_OK)) == 0
- && client->resp->line_num == 0)
- {
- /* get the end data by response result, return response state END_OK. */
- client->resp_status = AT_RESP_OK;
- }
- else if (strstr(client->recv_buffer, AT_RESP_END_ERROR)
- || (memcmp(client->recv_buffer, AT_RESP_END_FAIL, strlen(AT_RESP_END_FAIL)) == 0))
- {
- client->resp_status = AT_RESP_ERROR;
- }
- else if (line_counts == client->resp->line_num && client->resp->line_num)
- {
- /* get the end data by response line, return response state END_OK.*/
- client->resp_status = AT_RESP_OK;
- }
- else
- {
- continue;
- }
- client->resp->line_counts = line_counts;
- client->resp = RT_NULL;
- rt_sem_release(client->resp_notice);
- resp_buf_len = 0, line_counts = 0;
- }
- else
- {
- // log_d("unrecognized line: %.*s", client->cur_recv_len, client->recv_buffer);
- }
- }
- }
- }
- static rt_err_t at_client_rx_ind(rt_device_t dev, rt_size_t size)
- {
- if (size > 0)
- {
- rt_sem_release(at_client_local->rx_notice);
- }
- return RT_EOK;
- }
- /**
- * Set URC(Unsolicited Result Code) table
- *
- * @param table URC table
- * @param size table size
- */
- void at_set_urc_table(const struct at_urc *table, rt_size_t size)
- {
- rt_size_t idx;
- for(idx = 0; idx < size; idx++)
- {
- RT_ASSERT(table[idx].cmd_prefix);
- RT_ASSERT(table[idx].cmd_suffix);
- }
- at_client_local->urc_table = table;
- at_client_local->urc_table_size = size;
- }
- int at_client_init(void)
- {
- int result = RT_EOK;
- rt_err_t open_result = RT_EOK;
- if (at_client_local)
- {
- return result;
- }
- at_client_local = (at_client_t) rt_calloc(1, sizeof(struct at_client));
- if (!at_client_local)
- {
- result = -RT_ERROR;
- LOG_E("AT client session initialize failed! No memory for at_client structure !");
- goto __exit;
- }
- at_client_local->status = AT_STATUS_UNINITIALIZED;
- at_client_local->lock = rt_mutex_create("at_lock", RT_IPC_FLAG_FIFO);
- if(!at_client_local->lock)
- {
- LOG_E("AT client session initialize failed! at_client_recv_lock create failed!");
- result = -RT_ENOMEM;
- goto __exit;
- }
- at_client_local->cur_recv_len = 0;
- at_client_local->rx_notice = rt_sem_create("at_client_notice", 0, RT_IPC_FLAG_FIFO);
- if (!at_client_local->rx_notice)
- {
- LOG_E("AT client session initialize failed! at_client_notice semaphore create failed!");
- result = -RT_ENOMEM;
- goto __exit;
- }
- at_client_local->resp_notice = rt_sem_create("at_client_resp", 0, RT_IPC_FLAG_FIFO);
- if (!at_client_local->resp_notice)
- {
- LOG_E("AT client session initialize failed! at_client_resp semaphore create failed!");
- result = -RT_ENOMEM;
- goto __exit;
- }
- /* Find and open command device */
- at_client_local->device = rt_device_find(AT_CLIENT_DEVICE);
- if (at_client_local->device)
- {
- RT_ASSERT(at_client_local->device->type == RT_Device_Class_Char);
- /* using DMA mode first */
- open_result = rt_device_open(at_client_local->device, RT_DEVICE_OFLAG_RDWR | RT_DEVICE_FLAG_DMA_RX);
- /* using interrupt mode when DMA mode not supported */
- if (open_result == -RT_EIO)
- {
- open_result = rt_device_open(at_client_local->device, RT_DEVICE_OFLAG_RDWR | RT_DEVICE_FLAG_INT_RX);
- }
- RT_ASSERT(open_result == RT_EOK);
- rt_device_set_rx_indicate(at_client_local->device, at_client_rx_ind);
- }
- else
- {
- LOG_E("AT client device initialize failed! Not find the device : %s.", AT_CLIENT_DEVICE);
- result = -RT_ERROR;
- goto __exit;
- }
- at_client_local->urc_table = RT_NULL;
- at_client_local->urc_table_size = 0;
- at_client_local->parser = rt_thread_create("at_client",
- (void (*)(void *parameter))client_parser,
- at_client_local,
- 1024 + 512,
- RT_THREAD_PRIORITY_MAX / 3 - 1,
- 5);
- if (at_client_local->parser == RT_NULL)
- {
- result = -RT_ENOMEM;
- goto __exit;
- }
- if ((result = at_client_port_init()) != RT_EOK)
- {
- LOG_E("AT client port initialize failed(%d).", result);
- }
- __exit:
- if (!result)
- {
- at_client_local->status = AT_STATUS_INITIALIZED;
- rt_thread_startup(at_client_local->parser);
- LOG_I("RT-Thread AT client (V%s) initialize success.", AT_SW_VERSION);
- }
- else
- {
- if (at_client_local)
- {
- rt_free(at_client_local);
- }
- LOG_E("RT-Thread AT client (V%s) initialize failed(%d).", AT_SW_VERSION, result);
- }
- return result;
- }
- INIT_COMPONENT_EXPORT(at_client_init);
- RT_WEAK int at_client_port_init(void)
- {
- at_client_local->urc_table = RT_NULL;
- at_client_local->urc_table_size = 0;
- LOG_E("The client porting initialize for AT client is not implement.");
- return 0;
- }
|