at_socket.c 27 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138
  1. /*
  2. * File : at_socket.c
  3. * This file is part of RT-Thread RTOS
  4. * COPYRIGHT (C) 2006 - 2018, RT-Thread Development Team
  5. *
  6. * This program is free software; you can redistribute it and/or modify
  7. * it under the terms of the GNU General Public License as published by
  8. * the Free Software Foundation; either version 2 of the License, or
  9. * (at your option) any later version.
  10. *
  11. * This program is distributed in the hope that it will be useful,
  12. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  13. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  14. * GNU General Public License for more details.
  15. *
  16. * You should have received a copy of the GNU General Public License along
  17. * with this program; if not, write to the Free Software Foundation, Inc.,
  18. * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
  19. *
  20. * Change Logs:
  21. * Date Author Notes
  22. * 2018-06-06 chenyong first version
  23. */
  24. #include <at.h>
  25. #include <stdlib.h>
  26. #include <string.h>
  27. #include <ctype.h>
  28. #include <at_socket.h>
  29. #ifdef SAL_USING_POSIX
  30. #include <dfs_poll.h>
  31. #endif
  32. #ifdef DBG_SECTION_NAME
  33. #undef DBG_SECTION_NAME
  34. #define DBG_SECTION_NAME "[AT_SOC] "
  35. #endif
  36. #define HTONS_PORT(x) ((((x) & 0x00ffUL) << 8) | (((x) & 0xff00UL) >> 8))
  37. #define NIPQUAD(addr) \
  38. ((unsigned char *)&addr)[0], \
  39. ((unsigned char *)&addr)[1], \
  40. ((unsigned char *)&addr)[2], \
  41. ((unsigned char *)&addr)[3]
  42. #ifdef AT_DEVICE_NOT_SELECTED
  43. #error The AT socket device is not selected, please select it through the env menuconfig.
  44. #endif
  45. /* The maximum number of sockets structure */
  46. #ifndef AT_SOCKETS_NUM
  47. #define AT_SOCKETS_NUM AT_DEVICE_SOCKETS_NUM
  48. #endif
  49. typedef enum {
  50. AT_EVENT_SEND,
  51. AT_EVENT_RECV,
  52. AT_EVENT_ERROR,
  53. } at_event_t;
  54. /* the global array of available sockets */
  55. static struct at_socket sockets[AT_SOCKETS_NUM] = { 0 };
  56. /* the global AT socket lock */
  57. static rt_mutex_t at_socket_lock = RT_NULL;
  58. /* AT device socket options */
  59. static struct at_device_ops *at_dev_ops = RT_NULL;
  60. struct at_socket *at_get_socket(int socket)
  61. {
  62. if (socket < 0 || socket >= AT_SOCKETS_NUM)
  63. {
  64. return RT_NULL;
  65. }
  66. /* check socket structure valid or not */
  67. if (sockets[socket].magic != AT_SOCKET_MAGIC)
  68. {
  69. return RT_NULL;
  70. }
  71. return &sockets[socket];
  72. }
  73. /* get a block to the AT socket receive list*/
  74. static size_t at_recvpkt_put(rt_slist_t *rlist, const char *ptr, size_t length)
  75. {
  76. at_recv_pkt_t pkt;
  77. pkt = (at_recv_pkt_t) rt_calloc(1, sizeof(struct at_recv_pkt));
  78. if (!pkt)
  79. {
  80. LOG_E("No memory for receive packet table!");
  81. return 0;
  82. }
  83. pkt->bfsz_totle = length;
  84. pkt->bfsz_index = 0;
  85. pkt->buff = (char *) ptr;
  86. rt_slist_append(rlist, &pkt->list);
  87. return length;
  88. }
  89. /* delete and free all receive buffer list */
  90. static int at_recvpkt_all_delete(rt_slist_t *rlist)
  91. {
  92. at_recv_pkt_t pkt;
  93. rt_slist_t *node;
  94. if(rt_slist_isempty(rlist))
  95. return 0;
  96. for(node = rt_slist_first(rlist); node; node = rt_slist_next(node))
  97. {
  98. pkt = rt_slist_entry(node, struct at_recv_pkt, list);
  99. if (pkt->buff)
  100. {
  101. rt_free(pkt->buff);
  102. }
  103. if(pkt)
  104. {
  105. rt_free(pkt);
  106. pkt = RT_NULL;
  107. }
  108. }
  109. return 0;
  110. }
  111. /* delete and free specified list block */
  112. static int at_recvpkt_node_delete(rt_slist_t *rlist, rt_slist_t *node)
  113. {
  114. at_recv_pkt_t pkt;
  115. if(rt_slist_isempty(rlist))
  116. return 0;
  117. rt_slist_remove(rlist, node);
  118. pkt= rt_slist_entry(node, struct at_recv_pkt, list);
  119. if (pkt->buff)
  120. {
  121. rt_free(pkt->buff);
  122. }
  123. if (pkt)
  124. {
  125. rt_free(pkt);
  126. pkt = RT_NULL;
  127. }
  128. return 0;
  129. }
  130. /* get a block from AT socket receive list */
  131. static size_t at_recvpkt_get(rt_slist_t *rlist, char *mem, size_t len)
  132. {
  133. rt_slist_t *node;
  134. at_recv_pkt_t pkt;
  135. size_t content_pos = 0, page_pos = 0;
  136. if(rt_slist_isempty(rlist))
  137. return 0;
  138. for (node = rt_slist_first(rlist); node; node = rt_slist_next(node))
  139. {
  140. pkt = rt_slist_entry(node, struct at_recv_pkt, list);
  141. page_pos = pkt->bfsz_totle - pkt->bfsz_index;
  142. if (page_pos >= len - content_pos)
  143. {
  144. memcpy((char *) mem + content_pos, pkt->buff + pkt->bfsz_index, len - content_pos);
  145. pkt->bfsz_index += len - content_pos;
  146. if (pkt->bfsz_index == pkt->bfsz_totle)
  147. {
  148. at_recvpkt_node_delete(rlist, node);
  149. }
  150. content_pos = len;
  151. break;
  152. }
  153. else
  154. {
  155. memcpy((char *) mem + content_pos, pkt->buff + pkt->bfsz_index, page_pos);
  156. content_pos += page_pos;
  157. pkt->bfsz_index += page_pos;
  158. at_recvpkt_node_delete(rlist, node);
  159. }
  160. }
  161. return content_pos;
  162. }
  163. static void at_do_event_changes(struct at_socket *sock, at_event_t event, rt_bool_t is_plus)
  164. {
  165. switch (event)
  166. {
  167. case AT_EVENT_SEND:
  168. {
  169. if (is_plus)
  170. {
  171. sock->sendevent++;
  172. #ifdef SAL_USING_POSIX
  173. rt_wqueue_wakeup(&sock->wait_head, (void*) POLLOUT);
  174. #endif
  175. }
  176. else if (sock->sendevent)
  177. {
  178. sock->sendevent --;
  179. }
  180. break;
  181. }
  182. case AT_EVENT_RECV:
  183. {
  184. if (is_plus)
  185. {
  186. sock->rcvevent++;
  187. #ifdef SAL_USING_POSIX
  188. rt_wqueue_wakeup(&sock->wait_head, (void*) POLLIN);
  189. #endif
  190. }
  191. else if (sock->rcvevent)
  192. {
  193. sock->rcvevent --;
  194. }
  195. break;
  196. }
  197. case AT_EVENT_ERROR:
  198. {
  199. if (is_plus)
  200. {
  201. sock->errevent++;
  202. #ifdef SAL_USING_POSIX
  203. rt_wqueue_wakeup(&sock->wait_head, (void*) POLLERR);
  204. #endif
  205. }
  206. else if (sock->errevent)
  207. {
  208. sock->errevent --;
  209. }
  210. break;
  211. }
  212. default:
  213. LOG_E("Not supported event (%d)", event)
  214. }
  215. }
  216. static struct at_socket *alloc_socket(void)
  217. {
  218. char sem_name[RT_NAME_MAX];
  219. char lock_name[RT_NAME_MAX];
  220. struct at_socket *sock;
  221. int idx;
  222. rt_mutex_take(at_socket_lock, RT_WAITING_FOREVER);
  223. /* find an empty at socket entry */
  224. for (idx = 0; idx < AT_SOCKETS_NUM && sockets[idx].magic; idx++);
  225. /* can't find an empty protocol family entry */
  226. if (idx == AT_SOCKETS_NUM)
  227. {
  228. goto __err;
  229. }
  230. sock = &(sockets[idx]);
  231. sock->magic = AT_SOCKET_MAGIC;
  232. sock->socket = idx;
  233. sock->state = AT_SOCKET_NONE;
  234. sock->rcvevent = RT_NULL;
  235. sock->sendevent = RT_NULL;
  236. sock->errevent = RT_NULL;
  237. rt_slist_init(&sock->recvpkt_list);
  238. rt_snprintf(sem_name, RT_NAME_MAX, "%s%d", "at_recv_notice_", idx);
  239. /* create AT socket receive mailbox */
  240. if ((sock->recv_notice = rt_sem_create(sem_name, 0, RT_IPC_FLAG_FIFO)) == RT_NULL)
  241. {
  242. goto __err;
  243. }
  244. rt_snprintf(lock_name, RT_NAME_MAX, "%s%d", "at_recv_lock_", idx);
  245. /* create AT socket receive ring buffer lock */
  246. if((sock->recv_lock = rt_mutex_create(lock_name, RT_IPC_FLAG_FIFO)) == RT_NULL)
  247. {
  248. goto __err;
  249. }
  250. rt_mutex_release(at_socket_lock);
  251. return sock;
  252. __err:
  253. rt_mutex_release(at_socket_lock);
  254. return RT_NULL;
  255. }
  256. int at_socket(int domain, int type, int protocol)
  257. {
  258. struct at_socket *sock;
  259. enum at_socket_type socket_type;
  260. /* check socket family protocol */
  261. RT_ASSERT(domain == AF_AT||domain == AF_INET);
  262. //TODO check protocol
  263. switch(type)
  264. {
  265. case SOCK_STREAM:
  266. socket_type = AT_SOCKET_TCP;
  267. break;
  268. case SOCK_DGRAM:
  269. socket_type = AT_SOCKET_UDP;
  270. break;
  271. default :
  272. LOG_E("Don't support socket type (%d)!", type);
  273. return -1;
  274. }
  275. /* allocate and initialize a new AT socket */
  276. sock = alloc_socket();
  277. if(!sock)
  278. {
  279. LOG_E("Allocate a new AT socket failed!");
  280. return RT_NULL;
  281. }
  282. sock->type = socket_type;
  283. #ifdef SAL_USING_POSIX
  284. rt_wqueue_init(&sock->wait_head);
  285. #endif
  286. return sock->socket;
  287. }
  288. static int free_socket(struct at_socket *sock)
  289. {
  290. if (sock->recv_notice)
  291. {
  292. rt_sem_delete(sock->recv_notice);
  293. }
  294. if (sock->recv_lock)
  295. {
  296. rt_mutex_delete(sock->recv_lock);
  297. }
  298. if (!rt_slist_isempty(&sock->recvpkt_list))
  299. {
  300. at_recvpkt_all_delete(&sock->recvpkt_list);
  301. }
  302. memset(sock, 0x00, sizeof(struct at_socket));
  303. return 0;
  304. }
  305. int at_closesocket(int socket)
  306. {
  307. struct at_socket *sock;
  308. enum at_socket_state last_state;
  309. if (!at_dev_ops)
  310. {
  311. LOG_E("Please register AT device socket options first!");
  312. return -1;
  313. }
  314. if ((sock = at_get_socket(socket)) == RT_NULL)
  315. return -1;
  316. last_state = sock->state;
  317. /* the rt_at_socket_close is need some time, so change state in advance */
  318. sock->state = AT_SOCKET_CLOSED;
  319. if (last_state == AT_SOCKET_CONNECT)
  320. {
  321. if (at_dev_ops->close(socket) != 0)
  322. {
  323. LOG_E("AT socket (%d) closesocket failed!", socket);
  324. }
  325. }
  326. return free_socket(sock);
  327. }
  328. int at_shutdown(int socket, int how)
  329. {
  330. struct at_socket *sock;
  331. if (!at_dev_ops)
  332. {
  333. LOG_E("Please register AT device socket options first!");
  334. return -1;
  335. }
  336. if ((sock = at_get_socket(socket)) == RT_NULL)
  337. return -1;
  338. if (sock->state == AT_SOCKET_CONNECT)
  339. {
  340. if (at_dev_ops->close(socket) != 0)
  341. {
  342. LOG_E("AT socket (%d) shutdown failed!", socket);
  343. }
  344. }
  345. return free_socket(sock);
  346. }
  347. int at_bind(int socket, const struct sockaddr *name, socklen_t namelen)
  348. {
  349. if (at_get_socket(socket) == RT_NULL)
  350. return -1;
  351. return 0;
  352. }
  353. /* get IP address and port by socketaddr structure information */
  354. static int socketaddr_to_ipaddr_port(const struct sockaddr *sockaddr, ip_addr_t *addr, uint16_t *port)
  355. {
  356. const struct sockaddr_in* sin = (const struct sockaddr_in*) (const void *) sockaddr;
  357. (*addr).u_addr.ip4.addr = sin->sin_addr.s_addr;
  358. *port = (uint16_t) HTONS_PORT(sin->sin_port);
  359. return 0;
  360. }
  361. /* ipaddr structure change to IP address */
  362. static int ipaddr_to_ipstr(const struct sockaddr *sockaddr, char *ipstr)
  363. {
  364. struct sockaddr_in *sin = (struct sockaddr_in *) sockaddr;
  365. /* change network ip_addr to ip string */
  366. rt_snprintf(ipstr, 16, "%u.%u.%u.%u", NIPQUAD(sin->sin_addr.s_addr));
  367. return 0;
  368. }
  369. static void at_recv_notice_cb(int socket, at_socket_evt_t event, const char *buff, size_t bfsz)
  370. {
  371. struct at_socket *sock;
  372. RT_ASSERT(buff);
  373. RT_ASSERT(bfsz);
  374. RT_ASSERT(event == AT_SOCKET_EVT_RECV);
  375. if ((sock = at_get_socket(socket)) == RT_NULL)
  376. return ;
  377. /* put receive buffer to receiver packet list */
  378. rt_mutex_take(sock->recv_lock, RT_WAITING_FOREVER);
  379. at_recvpkt_put(&(sock->recvpkt_list), buff, bfsz);
  380. rt_mutex_release(sock->recv_lock);
  381. rt_sem_release(sock->recv_notice);
  382. at_do_event_changes(sock, AT_EVENT_RECV, RT_TRUE);
  383. }
  384. static void at_closed_notice_cb(int socket, at_socket_evt_t event, const char *buff, size_t bfsz)
  385. {
  386. struct at_socket *sock;
  387. RT_ASSERT(event == AT_SOCKET_EVT_CLOSED);
  388. if ((sock = at_get_socket(socket)) == RT_NULL)
  389. return ;
  390. at_do_event_changes(sock, AT_EVENT_RECV, RT_TRUE);
  391. at_do_event_changes(sock, AT_EVENT_ERROR, RT_TRUE);
  392. // LOG_D("socket (%d) closed by remote");
  393. sock->state = AT_SOCKET_CLOSED;
  394. rt_sem_release(sock->recv_notice);
  395. }
  396. int at_connect(int socket, const struct sockaddr *name, socklen_t namelen)
  397. {
  398. struct at_socket *sock;
  399. ip_addr_t remote_addr;
  400. uint16_t remote_port;
  401. char ipstr[16] = { 0 };
  402. int result = 0;
  403. if (!at_dev_ops)
  404. {
  405. LOG_E("Please register AT device socket options first!");
  406. return -1;
  407. }
  408. sock = at_get_socket(socket);
  409. if (!sock)
  410. {
  411. result = -1;
  412. goto __exit;
  413. }
  414. if (sock->state != AT_SOCKET_NONE)
  415. {
  416. LOG_E("Socket %d connect state is %d.", sock->socket, sock->state);
  417. result = -1;
  418. goto __exit;
  419. }
  420. /* get IP address and port by socketaddr structure */
  421. socketaddr_to_ipaddr_port(name, &remote_addr, &remote_port);
  422. ipaddr_to_ipstr(name, ipstr);
  423. if (at_dev_ops->connect(socket, ipstr, remote_port, sock->type, RT_TRUE) < 0)
  424. {
  425. LOG_E("AT socket(%d) connect failed!", socket);
  426. result = -1;
  427. goto __exit;
  428. }
  429. sock->state = AT_SOCKET_CONNECT;
  430. /* set AT socket receive data callback function */
  431. at_dev_ops->set_event_cb(AT_SOCKET_EVT_RECV, at_recv_notice_cb);
  432. at_dev_ops->set_event_cb(AT_SOCKET_EVT_CLOSED, at_closed_notice_cb);
  433. __exit:
  434. if (result < 0)
  435. {
  436. at_do_event_changes(sock, AT_EVENT_ERROR, RT_TRUE);
  437. }
  438. return result;
  439. }
  440. int at_recvfrom(int socket, void *mem, size_t len, int flags, struct sockaddr *from, socklen_t *fromlen)
  441. {
  442. struct at_socket *sock;
  443. int timeout;
  444. int result = 0;
  445. size_t recv_len = 0;
  446. if (!mem || len == 0)
  447. {
  448. LOG_E("AT recvfrom input data or length error!");
  449. result = -1;
  450. goto __exit;
  451. }
  452. if (!at_dev_ops)
  453. {
  454. LOG_E("Please register AT device socket options first!");
  455. return -1;
  456. }
  457. sock = at_get_socket(socket);
  458. if (!sock)
  459. {
  460. result = -1;
  461. goto __exit;
  462. }
  463. /* if the socket type is UDP, nead to connect socket first */
  464. if (from && sock->type == AT_SOCKET_UDP && sock->state == AT_SOCKET_NONE)
  465. {
  466. ip_addr_t remote_addr;
  467. uint16_t remote_port;
  468. char ipstr[16] = { 0 };
  469. socketaddr_to_ipaddr_port(from, &remote_addr, &remote_port);
  470. ipaddr_to_ipstr(from, ipstr);
  471. if (at_dev_ops->connect(socket, ipstr, remote_port, sock->type, RT_TRUE) < 0)
  472. {
  473. LOG_E("AT socket UDP connect failed!");
  474. result = -1;
  475. goto __exit;
  476. }
  477. sock->state = AT_SOCKET_CONNECT;
  478. }
  479. if (sock->state != AT_SOCKET_CONNECT)
  480. {
  481. LOG_E("received data error, current socket (%d) state (%d) is error.", socket, sock->state);
  482. result = -1;
  483. goto __exit;
  484. }
  485. /* receive packet list last transmission of remaining data */
  486. rt_mutex_take(sock->recv_lock, RT_WAITING_FOREVER);
  487. if((recv_len = at_recvpkt_get(&(sock->recvpkt_list), (char *)mem, len)) > 0)
  488. {
  489. rt_mutex_release(sock->recv_lock);
  490. goto __exit;
  491. }
  492. rt_mutex_release(sock->recv_lock);
  493. /* non-blocking sockets receive data */
  494. if (flags & MSG_DONTWAIT)
  495. {
  496. goto __exit;
  497. }
  498. /* set AT socket receive timeout */
  499. if((timeout = sock->recv_timeout) == 0)
  500. {
  501. timeout = RT_WAITING_FOREVER;
  502. }
  503. while (1)
  504. {
  505. /* wait the receive semaphore */
  506. if (rt_sem_take(sock->recv_notice, timeout) < 0)
  507. {
  508. LOG_E("AT socket (%d) receive timeout (%d)!", socket, timeout);
  509. result = -1;
  510. goto __exit;
  511. }
  512. else
  513. {
  514. if (sock->state == AT_SOCKET_CONNECT)
  515. {
  516. /* get receive buffer to receiver ring buffer */
  517. rt_mutex_take(sock->recv_lock, RT_WAITING_FOREVER);
  518. recv_len = at_recvpkt_get(&(sock->recvpkt_list), (char *) mem, len);
  519. rt_mutex_release(sock->recv_lock);
  520. if (recv_len > 0)
  521. {
  522. break;
  523. }
  524. }
  525. else
  526. {
  527. LOG_D("received data exit, current socket (%d) is closed by remote.", socket);
  528. result = -1;
  529. goto __exit;
  530. }
  531. }
  532. }
  533. __exit:
  534. if (result < 0)
  535. {
  536. at_do_event_changes(sock, AT_EVENT_ERROR, RT_TRUE);
  537. }
  538. else
  539. {
  540. result = recv_len;
  541. if (recv_len)
  542. {
  543. at_do_event_changes(sock, AT_EVENT_RECV, RT_FALSE);
  544. }
  545. }
  546. return result;
  547. }
  548. int at_recv(int s, void *mem, size_t len, int flags)
  549. {
  550. return at_recvfrom(s, mem, len, flags, RT_NULL, RT_NULL);
  551. }
  552. int at_sendto(int socket, const void *data, size_t size, int flags, const struct sockaddr *to, socklen_t tolen)
  553. {
  554. struct at_socket *sock;
  555. int len, result = 0;
  556. if (!at_dev_ops)
  557. {
  558. LOG_E("Please register AT device socket options first!");
  559. result = -1;
  560. goto __exit;
  561. }
  562. if (!data || size == 0)
  563. {
  564. LOG_E("AT sendto input data or size error!");
  565. result = -1;
  566. goto __exit;
  567. }
  568. sock = at_get_socket(socket);
  569. if (!sock)
  570. {
  571. result = -1;
  572. goto __exit;
  573. }
  574. switch (sock->type)
  575. {
  576. case AT_SOCKET_TCP:
  577. if (sock->state != AT_SOCKET_CONNECT)
  578. {
  579. LOG_E("send data error, current socket (%d) state (%d) is error.", socket, sock->state);
  580. result = -1;
  581. goto __exit;
  582. }
  583. if ((len = at_dev_ops->send(sock->socket, (const char *) data, size, sock->type)) < 0)
  584. {
  585. result = -1;
  586. goto __exit;
  587. }
  588. break;
  589. case AT_SOCKET_UDP:
  590. if (to && sock->state == AT_SOCKET_NONE)
  591. {
  592. ip_addr_t remote_addr;
  593. uint16_t remote_port;
  594. char ipstr[16] = { 0 };
  595. socketaddr_to_ipaddr_port(to, &remote_addr, &remote_port);
  596. ipaddr_to_ipstr(to, ipstr);
  597. if (at_dev_ops->connect(socket, ipstr, remote_port, sock->type, RT_TRUE) < 0)
  598. {
  599. LOG_E("AT socket (%d) UDP connect failed!", socket);
  600. result = -1;
  601. goto __exit;
  602. }
  603. sock->state = AT_SOCKET_CONNECT;
  604. }
  605. if ((len = at_dev_ops->send(sock->socket, (char *) data, size, sock->type)) < 0)
  606. {
  607. result = -1;
  608. goto __exit;
  609. }
  610. break;
  611. default:
  612. LOG_E("Socket (%d) type %d is not support.", socket, sock->type);
  613. result = -1;
  614. goto __exit;
  615. }
  616. __exit:
  617. if (result < 0)
  618. {
  619. at_do_event_changes(sock, AT_EVENT_ERROR, RT_TRUE);
  620. }
  621. else
  622. {
  623. result = len;
  624. }
  625. return result;
  626. }
  627. int at_send(int socket, const void *data, size_t size, int flags)
  628. {
  629. return at_sendto(socket, data, size, flags, RT_NULL, 0);
  630. }
  631. int at_getsockopt(int socket, int level, int optname, void *optval, socklen_t *optlen)
  632. {
  633. struct at_socket *sock;
  634. int32_t timeout;
  635. if (!optval || !optlen)
  636. {
  637. LOG_E("AT getsocketopt input option value or option length error!");
  638. return -1;
  639. }
  640. sock = at_get_socket(socket);
  641. if (!sock)
  642. {
  643. return -1;
  644. }
  645. switch (level)
  646. {
  647. case SOL_SOCKET:
  648. switch (optname)
  649. {
  650. case SO_RCVTIMEO:
  651. timeout = sock->recv_timeout;
  652. ((struct timeval *)(optval))->tv_sec = (timeout) / 1000U;
  653. ((struct timeval *)(optval))->tv_usec = (timeout % 1000U) * 1000U;
  654. break;
  655. case SO_SNDTIMEO:
  656. timeout = sock->send_timeout;
  657. ((struct timeval *) optval)->tv_sec = timeout / 1000U;
  658. ((struct timeval *) optval)->tv_usec = (timeout % 1000U) * 1000U;
  659. break;
  660. default:
  661. LOG_E("AT socket (%d) not support option name : %d.", socket, optname);
  662. return -1;
  663. }
  664. break;
  665. default:
  666. LOG_E("AT socket (%d) not support option level : %d.", socket, level);
  667. return -1;
  668. }
  669. return 0;
  670. }
  671. int at_setsockopt(int socket, int level, int optname, const void *optval, socklen_t optlen)
  672. {
  673. struct at_socket *sock;
  674. if (!optval)
  675. {
  676. LOG_E("AT setsockopt input option value error!");
  677. return -1;
  678. }
  679. sock = at_get_socket(socket);
  680. if (!sock)
  681. {
  682. return -1;
  683. }
  684. switch (level)
  685. {
  686. case SOL_SOCKET:
  687. switch (optname)
  688. {
  689. case SO_RCVTIMEO:
  690. sock->recv_timeout = ((const struct timeval *) optval)->tv_sec * 1000
  691. + ((const struct timeval *) optval)->tv_usec / 1000;
  692. break;
  693. case SO_SNDTIMEO:
  694. sock->send_timeout = ((const struct timeval *) optval)->tv_sec * 1000
  695. + ((const struct timeval *) optval)->tv_usec / 1000;
  696. break;
  697. default:
  698. LOG_E("AT socket (%d) not support option name : %d.", socket, optname);
  699. return -1;
  700. }
  701. break;
  702. case IPPROTO_TCP:
  703. switch (optname)
  704. {
  705. case TCP_NODELAY:
  706. break;
  707. }
  708. break;
  709. default:
  710. LOG_E("AT socket (%d) not support option level : %d.", socket, level);
  711. return -1;
  712. }
  713. return 0;
  714. }
  715. static uint32_t ipstr_atol(const char* nptr)
  716. {
  717. uint32_t total = 0;
  718. char sign = '+';
  719. /* jump space */
  720. while (isspace(*nptr))
  721. {
  722. ++nptr;
  723. }
  724. if (*nptr == '-' || *nptr == '+')
  725. {
  726. sign = *nptr++;
  727. }
  728. while (isdigit(*nptr))
  729. {
  730. total = 10 * total + ((*nptr++) - '0');
  731. }
  732. return (sign == '-') ? -total : total;
  733. }
  734. /* IP address to unsigned int type */
  735. static uint32_t ipstr_to_u32(char *ipstr)
  736. {
  737. char ipBytes[4] = { 0 };
  738. uint32_t i;
  739. for (i = 0; i < 4; i++, ipstr++)
  740. {
  741. ipBytes[i] = (char) ipstr_atol(ipstr);
  742. if ((ipstr = strchr(ipstr, '.')) == RT_NULL)
  743. {
  744. break;
  745. }
  746. }
  747. return *(uint32_t *) ipBytes;
  748. }
  749. struct hostent *at_gethostbyname(const char *name)
  750. {
  751. ip_addr_t addr;
  752. char ipstr[16] = { 0 };
  753. /* buffer variables for at_gethostbyname() */
  754. static struct hostent s_hostent;
  755. static char *s_aliases;
  756. static ip_addr_t s_hostent_addr;
  757. static ip_addr_t *s_phostent_addr[2];
  758. static char s_hostname[DNS_MAX_NAME_LENGTH + 1];
  759. size_t idx = 0;
  760. if (!name)
  761. {
  762. LOG_E("AT gethostbyname input name error!");
  763. return RT_NULL;
  764. }
  765. if (!at_dev_ops)
  766. {
  767. LOG_E("Please register AT device socket options first!");
  768. return RT_NULL;
  769. }
  770. for (idx = 0; idx < strlen(name) && !isalpha(name[idx]); idx++);
  771. if (idx < strlen(name))
  772. {
  773. if (at_dev_ops->domain_resolve(name, ipstr) < 0)
  774. {
  775. LOG_E("AT domain (%s) resolve error!", name);
  776. return RT_NULL;
  777. }
  778. }
  779. else
  780. {
  781. strncpy(ipstr, name, strlen(name));
  782. }
  783. addr.u_addr.ip4.addr = ipstr_to_u32(ipstr);
  784. /* fill hostent structure */
  785. s_hostent_addr = addr;
  786. s_phostent_addr[0] = &s_hostent_addr;
  787. s_phostent_addr[1] = RT_NULL;
  788. strncpy(s_hostname, name, DNS_MAX_NAME_LENGTH);
  789. s_hostname[DNS_MAX_NAME_LENGTH] = 0;
  790. s_hostent.h_name = s_hostname;
  791. s_aliases = RT_NULL;
  792. s_hostent.h_aliases = &s_aliases;
  793. s_hostent.h_addrtype = AF_AT;
  794. s_hostent.h_length = sizeof(ip_addr_t);
  795. s_hostent.h_addr_list = (char**) &s_phostent_addr;
  796. return &s_hostent;
  797. }
  798. int at_getaddrinfo(const char *nodename, const char *servname,
  799. const struct addrinfo *hints, struct addrinfo **res)
  800. {
  801. int port_nr = 0;
  802. ip_addr_t addr;
  803. struct addrinfo *ai;
  804. struct sockaddr_storage *sa;
  805. size_t total_size = 0;
  806. size_t namelen = 0;
  807. int ai_family = 0;
  808. if (res == RT_NULL)
  809. {
  810. return EAI_FAIL;
  811. }
  812. if (!at_dev_ops)
  813. {
  814. LOG_E("Please register AT device socket options first!");
  815. return EAI_FAIL;
  816. }
  817. *res = RT_NULL;
  818. if ((nodename == RT_NULL) && (servname == RT_NULL))
  819. {
  820. return EAI_NONAME;
  821. }
  822. if (hints != RT_NULL)
  823. {
  824. ai_family = hints->ai_family;
  825. if (hints->ai_family != AF_AT && hints->ai_family != AF_INET && hints->ai_family != AF_UNSPEC)
  826. {
  827. return EAI_FAMILY;
  828. }
  829. }
  830. if (servname != RT_NULL)
  831. {
  832. /* service name specified: convert to port number */
  833. port_nr = atoi(servname);
  834. if ((port_nr <= 0) || (port_nr > 0xffff))
  835. {
  836. return EAI_SERVICE;
  837. }
  838. }
  839. if (nodename != RT_NULL)
  840. {
  841. /* service location specified, try to resolve */
  842. if ((hints != RT_NULL) && (hints->ai_flags & AI_NUMERICHOST))
  843. {
  844. /* no DNS lookup, just parse for an address string */
  845. if (!inet_aton(nodename, (ip4_addr_t * )&addr))
  846. {
  847. return EAI_NONAME;
  848. }
  849. if (ai_family == AF_AT || ai_family == AF_INET)
  850. {
  851. return EAI_NONAME;
  852. }
  853. }
  854. else
  855. {
  856. char ip_str[16] = { 0 };
  857. size_t idx = 0;
  858. for (idx = 0; idx < strlen(nodename) && !isalpha(nodename[idx]); idx++);
  859. if(idx < strlen(nodename))
  860. {
  861. if (at_dev_ops->domain_resolve((char *) nodename, ip_str) != 0)
  862. {
  863. return EAI_FAIL;
  864. }
  865. }
  866. else
  867. {
  868. strncpy(ip_str, nodename, strlen(nodename));
  869. }
  870. addr.type = IPADDR_TYPE_V4;
  871. if ((addr.u_addr.ip4.addr = ipstr_to_u32(ip_str)) == 0)
  872. {
  873. return EAI_FAIL;
  874. }
  875. }
  876. }
  877. else
  878. {
  879. /* to do service location specified, use loopback address */
  880. }
  881. total_size = sizeof(struct addrinfo) + sizeof(struct sockaddr_storage);
  882. if (nodename != RT_NULL)
  883. {
  884. namelen = strlen(nodename);
  885. if (namelen > DNS_MAX_NAME_LENGTH)
  886. {
  887. /* invalid name length */
  888. return EAI_FAIL;
  889. }
  890. RT_ASSERT(total_size + namelen + 1 > total_size);
  891. total_size += namelen + 1;
  892. }
  893. /* If this fails, please report to lwip-devel! :-) */
  894. RT_ASSERT(total_size <= sizeof(struct addrinfo) + sizeof(struct sockaddr_storage) + DNS_MAX_NAME_LENGTH + 1);
  895. ai = (struct addrinfo *) rt_malloc(total_size);
  896. if (ai == RT_NULL)
  897. {
  898. return EAI_MEMORY;
  899. }
  900. memset(ai, 0, total_size);
  901. /* cast through void* to get rid of alignment warnings */
  902. sa = (struct sockaddr_storage *) (void *) ((uint8_t *) ai + sizeof(struct addrinfo));
  903. struct sockaddr_in *sa4 = (struct sockaddr_in *) sa;
  904. /* set up sockaddr */
  905. sa4->sin_addr.s_addr = addr.u_addr.ip4.addr;
  906. sa4->sin_family = AF_AT;
  907. sa4->sin_len = sizeof(struct sockaddr_in);
  908. sa4->sin_port = htons((u16_t )port_nr);
  909. ai->ai_family = AF_AT;
  910. /* set up addrinfo */
  911. if (hints != RT_NULL)
  912. {
  913. /* copy socktype & protocol from hints if specified */
  914. ai->ai_socktype = hints->ai_socktype;
  915. ai->ai_protocol = hints->ai_protocol;
  916. }
  917. if (nodename != RT_NULL)
  918. {
  919. /* copy nodename to canonname if specified */
  920. ai->ai_canonname = ((char *) ai + sizeof(struct addrinfo) + sizeof(struct sockaddr_storage));
  921. memcpy(ai->ai_canonname, nodename, namelen);
  922. ai->ai_canonname[namelen] = 0;
  923. }
  924. ai->ai_addrlen = sizeof(struct sockaddr_storage);
  925. ai->ai_addr = (struct sockaddr *) sa;
  926. *res = ai;
  927. return 0;
  928. }
  929. void at_freeaddrinfo(struct addrinfo *ai)
  930. {
  931. if (ai != RT_NULL)
  932. {
  933. rt_free(ai);
  934. }
  935. }
  936. void at_scoket_device_register(const struct at_device_ops *ops)
  937. {
  938. RT_ASSERT(ops);
  939. RT_ASSERT(ops->connect);
  940. RT_ASSERT(ops->close);
  941. RT_ASSERT(ops->send);
  942. RT_ASSERT(ops->domain_resolve);
  943. RT_ASSERT(ops->set_event_cb);
  944. at_dev_ops = (struct at_device_ops *) ops;
  945. }
  946. static int at_socket_init(void)
  947. {
  948. /* create AT socket lock */
  949. at_socket_lock = rt_mutex_create("at_socket_lock", RT_IPC_FLAG_FIFO);
  950. if (!at_socket_lock)
  951. {
  952. LOG_E("No memory for AT socket lock!");
  953. return -RT_ENOMEM;
  954. }
  955. return RT_EOK;
  956. }
  957. INIT_COMPONENT_EXPORT(at_socket_init);