at_socket.c 43 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625162616271628162916301631163216331634163516361637163816391640164116421643164416451646164716481649165016511652165316541655165616571658165916601661166216631664166516661667166816691670167116721673167416751676167716781679168016811682168316841685168616871688168916901691169216931694169516961697169816991700170117021703170417051706170717081709171017111712171317141715171617171718171917201721172217231724172517261727172817291730173117321733173417351736173717381739174017411742
  1. /*
  2. * Copyright (c) 2006-2024 RT-Thread Development Team
  3. *
  4. * SPDX-License-Identifier: Apache-2.0
  5. *
  6. * Change Logs:
  7. * Date Author Notes
  8. * 2018-06-06 chenyong first version
  9. * 2022-06-02 xianxistu add implement about "AT server"
  10. */
  11. #include <at.h>
  12. #ifdef AT_USING_SOCKET_SERVER
  13. #include <stdio.h>
  14. #endif
  15. #include <stdlib.h>
  16. #include <string.h>
  17. #include <ctype.h>
  18. #include <sys/time.h>
  19. #include <sys/errno.h>
  20. #include <at_socket.h>
  21. #include <at_device.h>
  22. #ifdef SAL_USING_POSIX
  23. #include <poll.h>
  24. #endif
  25. #include <arpa/inet.h>
  26. #include <netdev.h>
  27. #define LOG_TAG "at.skt"
  28. #include <at_log.h>
  29. #ifdef AT_USING_SOCKET
  30. #define HTONS_PORT(x) ((((x) & 0x00ffUL) << 8) | (((x) & 0xff00UL) >> 8))
  31. #define NIPQUAD(addr) \
  32. ((unsigned char *)&addr)[0], \
  33. ((unsigned char *)&addr)[1], \
  34. ((unsigned char *)&addr)[2], \
  35. ((unsigned char *)&addr)[3]
  36. /* The maximum number of sockets structure */
  37. #ifndef AT_SOCKETS_NUM
  38. #define AT_SOCKETS_NUM AT_DEVICE_SOCKETS_NUM
  39. #endif
  40. typedef enum {
  41. AT_EVENT_SEND,
  42. AT_EVENT_RECV,
  43. AT_EVENT_ERROR,
  44. } at_event_t;
  45. #ifdef AT_USING_SOCKET_SERVER
  46. static void at_connect_notice_cb(struct at_socket *sock, at_socket_evt_t event, const char *buff, size_t bfsz);
  47. #endif
  48. static rt_mutex_t at_slock = RT_NULL;
  49. /* the global of sockets list */
  50. static rt_slist_t _socket_list = RT_SLIST_OBJECT_INIT(_socket_list);
  51. struct at_socket *at_get_socket(int socket)
  52. {
  53. rt_base_t level;
  54. rt_slist_t *node = RT_NULL;
  55. struct at_socket *at_sock = RT_NULL;
  56. level = rt_hw_interrupt_disable();
  57. rt_slist_for_each(node, &_socket_list)
  58. {
  59. at_sock = rt_slist_entry(node, struct at_socket, list);
  60. if (at_sock && socket == at_sock->socket)
  61. {
  62. if (at_sock->magic == AT_SOCKET_MAGIC)
  63. {
  64. rt_hw_interrupt_enable(level);
  65. return at_sock;
  66. }
  67. }
  68. }
  69. rt_hw_interrupt_enable(level);
  70. return RT_NULL;
  71. }
  72. #ifdef AT_USING_SOCKET_SERVER
  73. struct at_socket *at_get_base_socket(int base_socket)
  74. {
  75. rt_base_t level;
  76. rt_slist_t *node = RT_NULL;
  77. struct at_socket *at_sock = RT_NULL;
  78. level = rt_hw_interrupt_disable();
  79. rt_slist_for_each(node, &_socket_list)
  80. {
  81. at_sock = rt_slist_entry(node, struct at_socket, list);
  82. if (at_sock && base_socket == (int)at_sock->user_data && at_sock->state != AT_SOCKET_LISTEN)
  83. {
  84. if (at_sock->magic == AT_SOCKET_MAGIC)
  85. {
  86. rt_hw_interrupt_enable(level);
  87. return at_sock;
  88. }
  89. }
  90. }
  91. rt_hw_interrupt_enable(level);
  92. return RT_NULL;
  93. }
  94. #endif
  95. /* get a block to the AT socket receive list*/
  96. static rt_err_t at_recvpkt_put(rt_slist_t *rlist, const char *ptr, size_t length)
  97. {
  98. at_recv_pkt_t pkt = RT_NULL;
  99. pkt = (at_recv_pkt_t) rt_calloc(1, sizeof(struct at_recv_pkt));
  100. if (pkt == RT_NULL)
  101. {
  102. LOG_E("No memory for receive packet table!");
  103. return -RT_ENOMEM;
  104. }
  105. pkt->bfsz_totle = length;
  106. pkt->bfsz_index = 0;
  107. pkt->buff = (char *) ptr;
  108. rt_slist_append(rlist, &pkt->list);
  109. return RT_EOK;
  110. }
  111. /* delete and free all receive buffer list */
  112. static int at_recvpkt_all_delete(rt_slist_t *rlist)
  113. {
  114. at_recv_pkt_t pkt = RT_NULL;
  115. rt_slist_t *node = RT_NULL;
  116. if (rt_slist_isempty(rlist))
  117. {
  118. return 0;
  119. }
  120. for(node = rt_slist_first(rlist); node;)
  121. {
  122. pkt = rt_slist_entry(node, struct at_recv_pkt, list);
  123. node = rt_slist_next(node);
  124. if (pkt && pkt->buff)
  125. {
  126. rt_free(pkt->buff);
  127. }
  128. if (pkt)
  129. {
  130. rt_free(pkt);
  131. pkt = RT_NULL;
  132. }
  133. }
  134. return 0;
  135. }
  136. /* delete and free specified list block */
  137. static int at_recvpkt_node_delete(rt_slist_t *rlist, rt_slist_t *node)
  138. {
  139. at_recv_pkt_t pkt = RT_NULL;
  140. if (rt_slist_isempty(rlist))
  141. {
  142. return 0;
  143. }
  144. rt_slist_remove(rlist, node);
  145. pkt = rt_slist_entry(node, struct at_recv_pkt, list);
  146. if (pkt && pkt->buff)
  147. {
  148. rt_free(pkt->buff);
  149. }
  150. if (pkt)
  151. {
  152. rt_free(pkt);
  153. pkt = RT_NULL;
  154. }
  155. return 0;
  156. }
  157. /* get a block from AT socket receive buffer list */
  158. static size_t at_recvpkt_get(rt_slist_t *rlist, char *mem, size_t len)
  159. {
  160. rt_slist_t *node = RT_NULL;
  161. rt_slist_t *free_node = RT_NULL;
  162. at_recv_pkt_t pkt = RT_NULL;
  163. size_t content_pos = 0, page_pos = 0;
  164. if (rt_slist_isempty(rlist))
  165. {
  166. return 0;
  167. }
  168. for (node = rt_slist_first(rlist); node;)
  169. {
  170. pkt = rt_slist_entry(node, struct at_recv_pkt, list);
  171. free_node = node;
  172. node = rt_slist_next(node);
  173. if (!pkt) continue;
  174. page_pos = pkt->bfsz_totle - pkt->bfsz_index;
  175. if (page_pos >= len - content_pos)
  176. {
  177. rt_memcpy((char *) mem + content_pos, pkt->buff + pkt->bfsz_index, len - content_pos);
  178. pkt->bfsz_index += len - content_pos;
  179. if (pkt->bfsz_index == pkt->bfsz_totle)
  180. {
  181. at_recvpkt_node_delete(rlist, free_node);
  182. }
  183. content_pos = len;
  184. break;
  185. }
  186. else
  187. {
  188. rt_memcpy((char *) mem + content_pos, pkt->buff + pkt->bfsz_index, page_pos);
  189. content_pos += page_pos;
  190. pkt->bfsz_index += page_pos;
  191. at_recvpkt_node_delete(rlist, free_node);
  192. }
  193. }
  194. return content_pos;
  195. }
  196. static void at_do_event_changes(struct at_socket *sock, at_event_t event, rt_bool_t is_plus)
  197. {
  198. switch (event)
  199. {
  200. case AT_EVENT_SEND:
  201. {
  202. if (is_plus)
  203. {
  204. sock->sendevent = 1;
  205. #ifdef SAL_USING_POSIX
  206. rt_wqueue_wakeup(&sock->wait_head, (void*) POLLOUT);
  207. #endif
  208. }
  209. else if (sock->sendevent)
  210. {
  211. sock->sendevent = 0;
  212. }
  213. break;
  214. }
  215. case AT_EVENT_RECV:
  216. {
  217. if (is_plus)
  218. {
  219. sock->rcvevent++;
  220. #ifdef SAL_USING_POSIX
  221. rt_wqueue_wakeup(&sock->wait_head, (void*) POLLIN);
  222. #endif
  223. }
  224. else if (sock->rcvevent)
  225. {
  226. sock->rcvevent --;
  227. }
  228. break;
  229. }
  230. case AT_EVENT_ERROR:
  231. {
  232. if (is_plus)
  233. {
  234. sock->errevent++;
  235. #ifdef SAL_USING_POSIX
  236. rt_wqueue_wakeup(&sock->wait_head, (void*) POLLERR);
  237. #endif
  238. }
  239. else if (sock->errevent)
  240. {
  241. sock->errevent --;
  242. }
  243. break;
  244. }
  245. default:
  246. LOG_E("Not supported event (%d)", event);
  247. }
  248. }
  249. static void at_do_event_clean(struct at_socket *sock, at_event_t event)
  250. {
  251. switch (event)
  252. {
  253. case AT_EVENT_SEND:
  254. {
  255. sock->sendevent = 0;
  256. break;
  257. }
  258. case AT_EVENT_RECV:
  259. {
  260. sock->rcvevent = 0;
  261. break;
  262. }
  263. case AT_EVENT_ERROR:
  264. {
  265. sock->errevent = 0;
  266. break;
  267. }
  268. default:
  269. LOG_E("Not supported event (%d)", event);
  270. }
  271. }
  272. static int free_socket(struct at_socket *sock)
  273. {
  274. if (at_slock == RT_NULL)
  275. {
  276. /* create AT socket lock */
  277. at_slock = rt_mutex_create("at_slock", RT_IPC_FLAG_PRIO);
  278. if (at_slock == RT_NULL)
  279. {
  280. LOG_E("No memory for socket allocation lock!");
  281. return RT_NULL;
  282. }
  283. }
  284. rt_mutex_take(at_slock, RT_WAITING_FOREVER);
  285. if (sock->recv_notice)
  286. {
  287. rt_sem_delete(sock->recv_notice);
  288. }
  289. if (sock->recv_lock)
  290. {
  291. rt_mutex_delete(sock->recv_lock);
  292. }
  293. if (!rt_slist_isempty(&sock->recvpkt_list))
  294. {
  295. at_recvpkt_all_delete(&sock->recvpkt_list);
  296. }
  297. /* delect socket from socket list */
  298. {
  299. rt_base_t level;
  300. rt_slist_t *node = RT_NULL;
  301. struct at_socket *at_sock = RT_NULL;
  302. level = rt_hw_interrupt_disable();
  303. rt_slist_for_each(node, &_socket_list)
  304. {
  305. at_sock = rt_slist_entry(node, struct at_socket, list);
  306. if (at_sock && sock->socket == at_sock->socket)
  307. {
  308. if (at_sock->magic == AT_SOCKET_MAGIC)
  309. {
  310. rt_slist_remove(&_socket_list, &at_sock->list);
  311. break;
  312. }
  313. }
  314. }
  315. rt_hw_interrupt_enable(level);
  316. }
  317. rt_memset(sock, RT_NULL, sizeof(struct at_socket));
  318. rt_mutex_release(at_slock);
  319. return 0;
  320. }
  321. static struct at_socket *alloc_socket_by_device(struct at_device *device, enum at_socket_type type)
  322. {
  323. rt_base_t level;
  324. struct at_socket *sock = RT_NULL;
  325. char name[RT_NAME_MAX] = {0};
  326. int idx = 0;
  327. if (at_slock == RT_NULL)
  328. {
  329. /* create AT socket lock */
  330. at_slock = rt_mutex_create("at_slock", RT_IPC_FLAG_PRIO);
  331. if (at_slock == RT_NULL)
  332. {
  333. LOG_E("No memory for socket allocation lock!");
  334. return RT_NULL;
  335. }
  336. }
  337. rt_mutex_take(at_slock, RT_WAITING_FOREVER);
  338. /* find an empty at socket entry */
  339. if (device->class->socket_ops->at_socket != RT_NULL)
  340. {
  341. idx = device->class->socket_ops->at_socket(device, type);
  342. }
  343. else
  344. {
  345. for (idx = 0; idx < device->class->socket_num && device->sockets[idx].magic == AT_SOCKET_MAGIC; idx++);
  346. }
  347. /* can't find an empty protocol family entry */
  348. if (idx < 0 || idx >= device->class->socket_num)
  349. {
  350. LOG_E("can't find an empty protocol family entry.");
  351. goto __err;
  352. }
  353. sock = &(device->sockets[idx]);
  354. /* the socket descriptor is the number of sockte lists */
  355. sock->socket = idx;
  356. /* the socket operations is the specify operations of the device */
  357. sock->ops = device->class->socket_ops;
  358. /* the user-data is the at device socket descriptor */
  359. sock->user_data = (void *) idx;
  360. sock->device = (void *) device;
  361. sock->magic = AT_SOCKET_MAGIC;
  362. sock->state = AT_SOCKET_NONE;
  363. sock->rcvevent = RT_NULL;
  364. sock->sendevent = RT_NULL;
  365. sock->errevent = RT_NULL;
  366. rt_slist_init(&(sock->list));
  367. level = rt_hw_interrupt_disable();
  368. rt_slist_insert(&_socket_list, &(sock->list));
  369. rt_hw_interrupt_enable(level);
  370. rt_slist_init(&sock->recvpkt_list);
  371. #ifdef SAL_USING_POSIX
  372. rt_wqueue_init(&sock->wait_head);
  373. #endif
  374. rt_snprintf(name, RT_NAME_MAX, "%s%d", "at_skt", idx);
  375. /* create AT socket receive semaphore */
  376. if ((sock->recv_notice = rt_sem_create(name, 0, RT_IPC_FLAG_FIFO)) == RT_NULL)
  377. {
  378. LOG_E("No memory socket receive notic semaphore create.");
  379. goto __err;
  380. }
  381. /* set AT socket receive semaphore 'max_value' to 1 */
  382. rt_sem_control(sock->recv_notice, RT_IPC_CMD_SET_VLIMIT, (void *)1);
  383. rt_snprintf(name, RT_NAME_MAX, "%s%d", "at_skt", idx);
  384. /* create AT socket receive ring buffer lock */
  385. if((sock->recv_lock = rt_mutex_create(name, RT_IPC_FLAG_PRIO)) == RT_NULL)
  386. {
  387. LOG_E("No memory for socket receive mutex create.");
  388. goto __err;
  389. }
  390. rt_mutex_release(at_slock);
  391. return sock;
  392. __err:
  393. rt_mutex_release(at_slock);
  394. if(sock != RT_NULL)
  395. {
  396. free_socket(sock);
  397. }
  398. return RT_NULL;
  399. }
  400. static struct at_socket *alloc_socket(enum at_socket_type type)
  401. {
  402. extern struct netdev *netdev_default;
  403. struct netdev *netdev = RT_NULL;
  404. struct at_device *device = RT_NULL;
  405. if (netdev_default && netdev_is_up(netdev_default) &&
  406. netdev_family_get(netdev_default) == AF_AT)
  407. {
  408. netdev = netdev_default;
  409. }
  410. else
  411. {
  412. /* get network interface device by protocol family AF_AT */
  413. netdev = netdev_get_by_family(AF_AT);
  414. if (netdev == RT_NULL)
  415. {
  416. return RT_NULL;
  417. }
  418. }
  419. device = at_device_get_by_name(AT_DEVICE_NAMETYPE_NETDEV, netdev->name);
  420. if (device == RT_NULL)
  421. {
  422. return RT_NULL;
  423. }
  424. return alloc_socket_by_device(device, type);
  425. }
  426. static void at_recv_notice_cb(struct at_socket *sock, at_socket_evt_t event, const char *buff, size_t bfsz);
  427. static void at_closed_notice_cb(struct at_socket *sock, at_socket_evt_t event, const char *buff, size_t bfsz);
  428. int at_socket(int domain, int type, int protocol)
  429. {
  430. struct at_socket *sock = RT_NULL;
  431. enum at_socket_type socket_type;
  432. /* check socket family protocol */
  433. if(domain != AF_INET && domain != AF_AT)
  434. {
  435. rt_set_errno(EAFNOSUPPORT);
  436. return -1;
  437. }
  438. /*TODO check protocol*/
  439. switch(type)
  440. {
  441. case SOCK_STREAM:
  442. socket_type = AT_SOCKET_TCP;
  443. break;
  444. case SOCK_DGRAM:
  445. socket_type = AT_SOCKET_UDP;
  446. break;
  447. default :
  448. LOG_E("Don't support socket type (%d)!", type);
  449. rt_set_errno(EPROTOTYPE);
  450. return -1;
  451. }
  452. /* allocate and initialize a new AT socket */
  453. sock = alloc_socket(socket_type);
  454. if (sock == RT_NULL)
  455. {
  456. LOG_E("Failed to allocate socket");
  457. rt_set_errno(EIO);
  458. return -1;
  459. }
  460. sock->type = socket_type;
  461. sock->state = AT_SOCKET_OPEN;
  462. /* set AT socket receive data callback function */
  463. sock->ops->at_set_event_cb(AT_SOCKET_EVT_RECV, at_recv_notice_cb);
  464. sock->ops->at_set_event_cb(AT_SOCKET_EVT_CLOSED, at_closed_notice_cb);
  465. #ifdef AT_USING_SOCKET_SERVER
  466. sock->ops->at_set_event_cb(AT_SOCKET_EVT_CONNECTED, at_connect_notice_cb);
  467. #endif
  468. return sock->socket;
  469. }
  470. int at_closesocket(int socket)
  471. {
  472. struct at_socket *sock = RT_NULL;
  473. enum at_socket_state last_state;
  474. /* deal with TCP server actively disconnect */
  475. rt_thread_delay(rt_tick_from_millisecond(100));
  476. sock = at_get_socket(socket);
  477. if (sock == RT_NULL)
  478. {
  479. rt_set_errno(ENXIO);
  480. return -1;
  481. }
  482. last_state = sock->state;
  483. /* the rt_at_socket_close is need some time, so change state in advance */
  484. sock->state = AT_SOCKET_CLOSED;
  485. if (last_state != AT_SOCKET_CLOSED)
  486. {
  487. if (sock->ops->at_closesocket(sock) != 0)
  488. {
  489. free_socket(sock);
  490. rt_set_errno(EIO);
  491. return -1;
  492. }
  493. }
  494. free_socket(sock);
  495. return 0;
  496. }
  497. int at_shutdown(int socket, int how)
  498. {
  499. struct at_socket *sock = RT_NULL;
  500. enum at_socket_state last_state;
  501. sock = at_get_socket(socket);
  502. if (sock == RT_NULL)
  503. {
  504. rt_set_errno(ENXIO);
  505. return -1;
  506. }
  507. last_state = sock->state;
  508. /* the rt_at_socket_close is need some time, so change state in advance */
  509. sock->state = AT_SOCKET_CLOSED;
  510. if (last_state != AT_SOCKET_CLOSED)
  511. {
  512. if (sock->ops->at_closesocket(sock) != 0)
  513. {
  514. free_socket(sock);
  515. rt_set_errno(EIO);
  516. return -1;
  517. }
  518. }
  519. free_socket(sock);
  520. return 0;
  521. }
  522. /* get IP address and port by socketaddr structure information */
  523. static int socketaddr_to_ipaddr_port(const struct sockaddr *sockaddr, ip_addr_t *addr, uint16_t *port)
  524. {
  525. const struct sockaddr_in* sin = (const struct sockaddr_in*) (const void *) sockaddr;
  526. #if NETDEV_IPV4 && NETDEV_IPV6
  527. addr->u_addr.ip4.addr = sin->sin_addr.s_addr;
  528. addr->type = IPADDR_TYPE_V4;
  529. #elif NETDEV_IPV4
  530. addr->addr = sin->sin_addr.s_addr;
  531. #elif NETDEV_IPV6
  532. #error "not support IPV6."
  533. #endif /* NETDEV_IPV4 && NETDEV_IPV6 */
  534. *port = (uint16_t) HTONS_PORT(sin->sin_port);
  535. return 0;
  536. }
  537. #ifdef AT_USING_SOCKET_SERVER
  538. /* set socketaddr structure information by IP address and port */
  539. static int ipaddr_port_to_socketaddr(struct sockaddr *sockaddr, ip_addr_t *addr, uint16_t *port)
  540. {
  541. struct sockaddr_in* sin = (struct sockaddr_in*) (void *) sockaddr;
  542. #if NETDEV_IPV4 && NETDEV_IPV6
  543. sin->sin_addr.s_addr = addr->u_addr.ip4.addr;
  544. #elif NETDEV_IPV4
  545. sin->sin_addr.s_addr = addr->addr;
  546. #elif NETDEV_IPV6
  547. #error "not support IPV6."
  548. #endif /* NETDEV_IPV4 && NETDEV_IPV6 */
  549. sin->sin_port = (uint16_t) HTONS_PORT(*port);
  550. return 0;
  551. }
  552. #endif
  553. int at_bind(int socket, const struct sockaddr *name, socklen_t namelen)
  554. {
  555. struct at_socket *sock = RT_NULL;
  556. struct at_device *device = RT_NULL;
  557. ip_addr_t input_ipaddr, local_ipaddr;
  558. uint16_t port = 0;
  559. if (name == NULL || namelen == 0)
  560. {
  561. rt_set_errno(EINVAL);
  562. return -1;
  563. }
  564. sock = at_get_socket(socket);
  565. if (sock == RT_NULL)
  566. {
  567. rt_set_errno(ENXIO);
  568. return -1;
  569. }
  570. /* get current device ip address */
  571. device = (struct at_device *) sock->device;
  572. ip_addr_copy(local_ipaddr, device->netdev->ip_addr);
  573. /* prase ip address and port from sockaddr structure */
  574. socketaddr_to_ipaddr_port(name, &input_ipaddr, &port);
  575. /* input ip address is different from device ip address */
  576. if (ip_addr_cmp(&input_ipaddr, &local_ipaddr) != 0)
  577. {
  578. struct at_socket *new_sock = RT_NULL;
  579. struct at_device *new_device = RT_NULL;
  580. enum at_socket_type type = sock->type;
  581. /* close old socket */
  582. if (at_closesocket(socket) < 0)
  583. {
  584. free_socket(sock);
  585. rt_set_errno(EIO);
  586. return -1;
  587. }
  588. extern struct at_device *at_device_get_by_ipaddr(ip_addr_t *ip_addr);
  589. new_device = at_device_get_by_ipaddr(&input_ipaddr);
  590. if (new_device == RT_NULL)
  591. {
  592. rt_set_errno(EHOSTUNREACH);
  593. return -1;
  594. }
  595. /* allocate new socket */
  596. new_sock = alloc_socket_by_device(new_device, type);
  597. if (new_sock == RT_NULL)
  598. {
  599. rt_set_errno(EIO);
  600. return -1;
  601. }
  602. new_sock->type = type;
  603. new_sock->state = AT_SOCKET_OPEN;
  604. }
  605. #ifdef AT_USING_SOCKET_SERVER
  606. /* store 'port' into at_socket */
  607. sock->listen.port = port;
  608. #endif
  609. return 0;
  610. }
  611. /* ipaddr structure change to IP address */
  612. static int ipaddr_to_ipstr(const struct sockaddr *sockaddr, char *ipstr)
  613. {
  614. struct sockaddr_in *sin = (struct sockaddr_in *) sockaddr;
  615. /* change network ip_addr to ip string */
  616. rt_snprintf(ipstr, 16, "%u.%u.%u.%u", NIPQUAD(sin->sin_addr.s_addr));
  617. return 0;
  618. }
  619. #ifdef AT_USING_SOCKET_SERVER
  620. static void at_connect_notice_cb(struct at_socket *sock, at_socket_evt_t event, const char *buff, size_t bfsz)
  621. {
  622. RT_ASSERT(buff);
  623. RT_ASSERT(sock == RT_NULL);
  624. RT_ASSERT(event == AT_SOCKET_EVT_CONNECTED);
  625. int new_socket;
  626. struct at_socket *new_sock = RT_NULL;
  627. rt_base_t level;
  628. rt_slist_t *node = RT_NULL;
  629. struct at_socket *at_sock = RT_NULL;
  630. char *socket_info = RT_NULL;
  631. int base_socket = 0;
  632. rt_sscanf(buff, "SOCKET:%d", &base_socket);
  633. LOG_D("ACCEPT BASE SOCKET: %d", base_socket);
  634. /* avoid use bottom driver to alloc "socket" */
  635. new_sock = at_get_base_socket(base_socket);
  636. if (new_sock)
  637. {
  638. new_sock->state = AT_SOCKET_CONNECT;
  639. return;
  640. }
  641. new_socket = at_socket(AF_AT, SOCK_STREAM, 0);
  642. if (new_socket == -1)
  643. {
  644. return;
  645. }
  646. new_sock = at_get_socket(new_socket);
  647. new_sock->state = AT_SOCKET_CONNECT;
  648. new_sock->user_data = (void *)base_socket;
  649. /* find out the listen socket */
  650. level = rt_hw_interrupt_disable();
  651. rt_slist_for_each(node, &_socket_list)
  652. {
  653. at_sock = rt_slist_entry(node, struct at_socket, list);
  654. if (at_sock && at_sock->magic == AT_SOCKET_MAGIC && at_sock->listen.is_listen == RT_TRUE)
  655. {
  656. break;
  657. }
  658. at_sock = RT_NULL;
  659. }
  660. rt_hw_interrupt_enable(level);
  661. if (at_sock == RT_NULL)
  662. {
  663. at_closesocket(new_socket);
  664. return;
  665. }
  666. /* put incoming "socket" to the listen socket receiver packet list */
  667. socket_info = rt_malloc(AT_SOCKET_INFO_LEN);
  668. rt_memset(socket_info, 0, AT_SOCKET_INFO_LEN);
  669. rt_sprintf(socket_info, "SOCKET:%d", new_sock->socket);
  670. /* wakeup the "accept" function */
  671. rt_mutex_take(at_sock->recv_lock, RT_WAITING_FOREVER);
  672. if (at_recvpkt_put(&(at_sock->recvpkt_list), socket_info, AT_SOCKET_INFO_LEN) != RT_EOK)
  673. {
  674. at_closesocket(new_socket);
  675. rt_free(socket_info);
  676. rt_mutex_release(at_sock->recv_lock);
  677. return;
  678. }
  679. rt_mutex_release(at_sock->recv_lock);
  680. rt_sem_release(at_sock->recv_notice);
  681. at_do_event_changes(at_sock, AT_EVENT_RECV, RT_TRUE);
  682. }
  683. #endif
  684. static void at_recv_notice_cb(struct at_socket *sock, at_socket_evt_t event, const char *buff, size_t bfsz)
  685. {
  686. RT_ASSERT(buff);
  687. RT_ASSERT(event == AT_SOCKET_EVT_RECV);
  688. /* check the socket object status */
  689. if (sock->magic != AT_SOCKET_MAGIC || sock->state == AT_SOCKET_CLOSED)
  690. {
  691. rt_free((void *)buff);
  692. return;
  693. }
  694. /* put receive buffer to receiver packet list */
  695. rt_mutex_take(sock->recv_lock, RT_WAITING_FOREVER);
  696. if (at_recvpkt_put(&(sock->recvpkt_list), buff, bfsz) != RT_EOK)
  697. {
  698. rt_free((void *)buff);
  699. rt_mutex_release(sock->recv_lock);
  700. return;
  701. }
  702. rt_mutex_release(sock->recv_lock);
  703. rt_sem_release(sock->recv_notice);
  704. at_do_event_changes(sock, AT_EVENT_RECV, RT_TRUE);
  705. }
  706. static void at_closed_notice_cb(struct at_socket *sock, at_socket_evt_t event, const char *buff, size_t bfsz)
  707. {
  708. RT_ASSERT(event == AT_SOCKET_EVT_CLOSED);
  709. /* check the socket object status */
  710. if (sock->magic != AT_SOCKET_MAGIC)
  711. {
  712. return;
  713. }
  714. at_do_event_changes(sock, AT_EVENT_RECV, RT_TRUE);
  715. at_do_event_changes(sock, AT_EVENT_ERROR, RT_TRUE);
  716. sock->state = AT_SOCKET_CLOSED;
  717. rt_sem_release(sock->recv_notice);
  718. }
  719. #ifdef AT_USING_SOCKET_SERVER
  720. int at_listen(int socket, int backlog)
  721. {
  722. struct at_socket *sock = RT_NULL;
  723. int result = 0;
  724. sock = at_get_socket(socket);
  725. if (sock == RT_NULL)
  726. {
  727. rt_set_errno(ENXIO);
  728. return -1;
  729. }
  730. if (sock->state != AT_SOCKET_OPEN)
  731. {
  732. LOG_E("Socket(%d) connect state is %d.", sock->socket, sock->state);
  733. rt_set_errno(ENETUNREACH);
  734. result = -1;
  735. goto __exit;
  736. }
  737. if (sock->ops->at_listen(sock, backlog) < 0)
  738. {
  739. rt_set_errno(EIO);
  740. result = -1;
  741. goto __exit;
  742. }
  743. sock->listen.is_listen = RT_TRUE;
  744. sock->state = AT_SOCKET_LISTEN;
  745. __exit:
  746. if (result < 0)
  747. {
  748. at_do_event_changes(sock, AT_EVENT_ERROR, RT_TRUE);
  749. }
  750. return result;
  751. }
  752. #endif
  753. int at_connect(int socket, const struct sockaddr *name, socklen_t namelen)
  754. {
  755. struct at_socket *sock = RT_NULL;
  756. ip_addr_t remote_addr;
  757. uint16_t remote_port = 0;
  758. char ipstr[16] = { 0 };
  759. int result = 0;
  760. if (name == RT_NULL || namelen == 0)
  761. {
  762. rt_set_errno(EINVAL);
  763. return -1;
  764. }
  765. sock = at_get_socket(socket);
  766. if (sock == RT_NULL)
  767. {
  768. rt_set_errno(ENXIO);
  769. return -1;
  770. }
  771. if (sock->state != AT_SOCKET_OPEN)
  772. {
  773. LOG_E("Socket(%d) connect state is %d.", sock->socket, sock->state);
  774. rt_set_errno(EPERM);
  775. result = -1;
  776. goto __exit;
  777. }
  778. /* get IP address and port by socketaddr structure */
  779. socketaddr_to_ipaddr_port(name, &remote_addr, &remote_port);
  780. ipaddr_to_ipstr(name, ipstr);
  781. if (sock->ops->at_connect(sock, ipstr, remote_port, sock->type, RT_TRUE) < 0)
  782. {
  783. rt_set_errno(EIO);
  784. result = -1;
  785. goto __exit;
  786. }
  787. sock->state = AT_SOCKET_CONNECT;
  788. __exit:
  789. if (result < 0)
  790. {
  791. at_do_event_changes(sock, AT_EVENT_ERROR, RT_TRUE);
  792. }
  793. else
  794. {
  795. at_do_event_changes(sock, AT_EVENT_SEND, RT_TRUE);
  796. }
  797. return result;
  798. }
  799. #ifdef AT_USING_SOCKET_SERVER
  800. int at_accept(int socket, struct sockaddr *name, socklen_t *namelen)
  801. {
  802. struct at_socket *sock = RT_NULL;
  803. struct at_socket *new_sock = RT_NULL;
  804. char receive_buff[AT_SOCKET_INFO_LEN];
  805. ip_addr_t remote_addr;
  806. uint16_t remote_port = 0;
  807. int new_socket = -1;
  808. int result = 0;
  809. sock = at_get_socket(socket);
  810. if (sock == RT_NULL)
  811. {
  812. rt_set_errno(ENXIO);
  813. return -1;
  814. }
  815. if (sock->state != AT_SOCKET_LISTEN)
  816. {
  817. LOG_E("Socket(%d) connect state is %d.", sock->socket, sock->state);
  818. rt_set_errno(EIO);
  819. result = -1;
  820. goto __exit;
  821. }
  822. /* wait the receive semaphore, waiting for info */
  823. if (rt_sem_take(sock->recv_notice, RT_WAITING_FOREVER) != RT_EOK)
  824. {
  825. rt_set_errno(EAGAIN);
  826. result = -1;
  827. goto __exit;
  828. }
  829. else
  830. {
  831. /* get receive buffer to receiver ring buffer */
  832. rt_mutex_take(sock->recv_lock, RT_WAITING_FOREVER);
  833. at_recvpkt_get(&(sock->recvpkt_list), (char *) &receive_buff, AT_SOCKET_INFO_LEN);
  834. rt_mutex_release(sock->recv_lock);
  835. at_do_event_changes(sock, AT_EVENT_RECV, RT_FALSE);
  836. }
  837. rt_sscanf(&receive_buff[0], "SOCKET:%d", &new_socket);
  838. new_sock = at_get_socket(new_socket);
  839. ip4_addr_set_any(&remote_addr);
  840. ipaddr_port_to_socketaddr(name, &remote_addr, &remote_port);
  841. LOG_D("Accept: [socket :%d, base_socket:%d]", new_socket, (int)new_sock->user_data);
  842. __exit:
  843. if (result < 0)
  844. {
  845. at_do_event_changes(sock, AT_EVENT_ERROR, RT_TRUE);
  846. return result;
  847. }
  848. return new_sock->socket;
  849. }
  850. #endif
  851. int at_recvfrom(int socket, void *mem, size_t len, int flags, struct sockaddr *from, socklen_t *fromlen)
  852. {
  853. struct at_socket *sock = RT_NULL;
  854. int timeout, result = 0;
  855. size_t recv_len = 0;
  856. if (mem == RT_NULL || len == 0)
  857. {
  858. /* if the requested number of bytes to receive from a stream socket was 0. */
  859. rt_set_errno(EFAULT);
  860. return -1;
  861. }
  862. sock = at_get_socket(socket);
  863. if (sock == RT_NULL)
  864. {
  865. rt_set_errno(ENXIO);
  866. return -1;
  867. }
  868. /* if the socket type is UDP, need to connect socket first */
  869. if (sock->type == AT_SOCKET_UDP)
  870. {
  871. if (from == RT_NULL || fromlen == 0)
  872. {
  873. rt_set_errno(EFAULT);
  874. return -1;
  875. }
  876. if(sock->state == AT_SOCKET_CONNECT && rt_memcmp(&sock->last_udp_adr, from, sizeof(struct sockaddr)) != 0)
  877. {
  878. if (sock->ops->at_closesocket(sock) != 0)
  879. {
  880. free_socket(sock);
  881. rt_set_errno(EIO);
  882. goto __exit;
  883. }
  884. sock->state = AT_SOCKET_OPEN;
  885. }
  886. if (sock->state == AT_SOCKET_OPEN)
  887. {
  888. ip_addr_t remote_addr;
  889. uint16_t remote_port = 0;
  890. char ipstr[16] = { 0 };
  891. socketaddr_to_ipaddr_port(from, &remote_addr, &remote_port);
  892. ipaddr_to_ipstr(from, ipstr);
  893. if (sock->ops->at_connect(sock, ipstr, remote_port, sock->type, RT_TRUE) < 0)
  894. {
  895. at_do_event_changes(sock, AT_EVENT_ERROR, RT_TRUE);
  896. rt_set_errno(EIO);
  897. /* socket shutdown */
  898. goto __exit;
  899. }
  900. rt_memcpy(&sock->last_udp_adr, from, sizeof(struct sockaddr));
  901. sock->state = AT_SOCKET_CONNECT;
  902. }
  903. }
  904. while (1)
  905. {
  906. /* receive packet list last transmission of remaining data */
  907. rt_mutex_take(sock->recv_lock, RT_WAITING_FOREVER);
  908. recv_len = at_recvpkt_get(&(sock->recvpkt_list), (char *)mem, len);
  909. rt_mutex_release(sock->recv_lock);
  910. if (recv_len > 0)
  911. {
  912. if (rt_slist_isempty(&sock->recvpkt_list))
  913. {
  914. at_do_event_clean(sock, AT_EVENT_RECV);
  915. }
  916. result = recv_len;
  917. goto __exit;
  918. }
  919. if (sock->state == AT_SOCKET_CLOSED)
  920. {
  921. /* socket passively closed, receive function return 0 */
  922. result = 0;
  923. goto __exit;
  924. }
  925. if (flags & MSG_DONTWAIT)
  926. {
  927. rt_set_errno(EAGAIN);
  928. result = -1;
  929. goto __exit;
  930. }
  931. /* set AT socket receive timeout */
  932. if (sock->recv_timeout == 0)
  933. {
  934. timeout = RT_WAITING_FOREVER;
  935. }
  936. else
  937. {
  938. timeout = rt_tick_from_millisecond(sock->recv_timeout);
  939. }
  940. if (rt_sem_take(sock->recv_notice, timeout) != RT_EOK)
  941. {
  942. LOG_D("AT socket (%d) receive timeout (%d)!", socket, timeout);
  943. rt_set_errno(EAGAIN);
  944. result = -1;
  945. goto __exit;
  946. }
  947. }
  948. __exit:
  949. if (result <= 0)
  950. {
  951. at_do_event_changes(sock, AT_EVENT_ERROR, RT_TRUE);
  952. }
  953. return result;
  954. }
  955. int at_recv(int s, void *mem, size_t len, int flags)
  956. {
  957. return at_recvfrom(s, mem, len, flags, RT_NULL, RT_NULL);
  958. }
  959. int at_sendto(int socket, const void *data, size_t size, int flags, const struct sockaddr *to, socklen_t tolen)
  960. {
  961. struct at_socket *sock = RT_NULL;
  962. int len = 0, result = 0;
  963. if (data == RT_NULL || size == 0)
  964. {
  965. LOG_E("AT sendto input data or size error!");
  966. rt_set_errno(EFAULT);
  967. return -1;
  968. }
  969. sock = at_get_socket(socket);
  970. if (sock == RT_NULL)
  971. {
  972. rt_set_errno(ENXIO);
  973. return -1;
  974. }
  975. switch (sock->type)
  976. {
  977. case AT_SOCKET_TCP:
  978. if (sock->state == AT_SOCKET_CLOSED)
  979. {
  980. /* socket passively closed, transmit function return 0 */
  981. result = 0;
  982. goto __exit;
  983. }
  984. else if (sock->state != AT_SOCKET_CONNECT)
  985. {
  986. LOG_E("send data error, current socket (%d) state (%d) is error.", socket, sock->state);
  987. rt_set_errno(ENETUNREACH);
  988. result = -1;
  989. goto __exit;
  990. }
  991. if ((len = sock->ops->at_send(sock, (const char *) data, size, sock->type)) < 0)
  992. {
  993. rt_set_errno(EIO);
  994. result = -1;
  995. goto __exit;
  996. }
  997. break;
  998. case AT_SOCKET_UDP:
  999. if (to == RT_NULL || tolen == 0)
  1000. {
  1001. rt_set_errno(EFAULT);
  1002. result = -1;
  1003. goto __exit;
  1004. }
  1005. /* Inconsistent with the last UDP sending address, reconnect to a new address */
  1006. if(sock->state == AT_SOCKET_CONNECT && rt_memcmp(&sock->last_udp_adr, to, sizeof(struct sockaddr)) != 0)
  1007. {
  1008. if (sock->ops->at_closesocket(sock) != 0)
  1009. {
  1010. free_socket(sock);
  1011. rt_set_errno(EIO);
  1012. goto __exit;
  1013. }
  1014. sock->state = AT_SOCKET_OPEN;
  1015. }
  1016. if (sock->state == AT_SOCKET_OPEN)
  1017. {
  1018. ip_addr_t remote_addr;
  1019. uint16_t remote_port = 0;
  1020. char ipstr[16] = { 0 };
  1021. socketaddr_to_ipaddr_port(to, &remote_addr, &remote_port);
  1022. ipaddr_to_ipstr(to, ipstr);
  1023. if (sock->ops->at_connect(sock, ipstr, remote_port, sock->type, RT_TRUE) < 0)
  1024. {
  1025. rt_set_errno(EIO);
  1026. result = -1;
  1027. goto __exit;
  1028. }
  1029. rt_memcpy(&sock->last_udp_adr, to, sizeof(struct sockaddr));
  1030. sock->state = AT_SOCKET_CONNECT;
  1031. }
  1032. if ((len = sock->ops->at_send(sock, (char *) data, size, sock->type)) < 0)
  1033. {
  1034. rt_set_errno(EIO);
  1035. result = -1;
  1036. goto __exit;
  1037. }
  1038. break;
  1039. default:
  1040. LOG_E("Socket (%d) type %d is not support.", socket, sock->type);
  1041. rt_set_errno(EPERM);
  1042. result = -1;
  1043. goto __exit;
  1044. }
  1045. __exit:
  1046. if (result < 0)
  1047. {
  1048. at_do_event_changes(sock, AT_EVENT_ERROR, RT_TRUE);
  1049. }
  1050. else
  1051. {
  1052. result = len;
  1053. }
  1054. return result;
  1055. }
  1056. int at_send(int socket, const void *data, size_t size, int flags)
  1057. {
  1058. return at_sendto(socket, data, size, flags, RT_NULL, 0);
  1059. }
  1060. int at_getsockopt(int socket, int level, int optname, void *optval, socklen_t *optlen)
  1061. {
  1062. struct at_socket *sock;
  1063. int32_t timeout;
  1064. if (optval == RT_NULL || optlen == RT_NULL)
  1065. {
  1066. LOG_E("AT getsocketopt input option value or option length error!");
  1067. rt_set_errno(EFAULT);
  1068. return -1;
  1069. }
  1070. sock = at_get_socket(socket);
  1071. if (sock == RT_NULL)
  1072. {
  1073. rt_set_errno(ENXIO);
  1074. return -1;
  1075. }
  1076. switch (level)
  1077. {
  1078. case SOL_SOCKET:
  1079. switch (optname)
  1080. {
  1081. case SO_RCVTIMEO:
  1082. timeout = sock->recv_timeout;
  1083. ((struct timeval *)(optval))->tv_sec = (timeout) / 1000U;
  1084. ((struct timeval *)(optval))->tv_usec = (timeout % 1000U) * 1000U;
  1085. break;
  1086. case SO_SNDTIMEO:
  1087. timeout = sock->send_timeout;
  1088. ((struct timeval *) optval)->tv_sec = timeout / 1000U;
  1089. ((struct timeval *) optval)->tv_usec = (timeout % 1000U) * 1000U;
  1090. break;
  1091. default:
  1092. LOG_E("AT socket (%d) not support option name : %d.", socket, optname);
  1093. rt_set_errno(EPERM);
  1094. return -1;
  1095. }
  1096. break;
  1097. default:
  1098. LOG_E("AT socket (%d) not support option level : %d.", socket, level);
  1099. rt_set_errno(EPERM);
  1100. return -1;
  1101. }
  1102. return 0;
  1103. }
  1104. int at_setsockopt(int socket, int level, int optname, const void *optval, socklen_t optlen)
  1105. {
  1106. struct at_socket *sock;
  1107. if (optval == RT_NULL)
  1108. {
  1109. LOG_E("AT setsockopt input option value error!");
  1110. rt_set_errno(EFAULT);
  1111. return -1;
  1112. }
  1113. sock = at_get_socket(socket);
  1114. if (sock == RT_NULL)
  1115. {
  1116. rt_set_errno(ENXIO);
  1117. return -1;
  1118. }
  1119. switch (level)
  1120. {
  1121. case SOL_SOCKET:
  1122. switch (optname)
  1123. {
  1124. case SO_RCVTIMEO:
  1125. sock->recv_timeout = ((const struct timeval *) optval)->tv_sec * 1000
  1126. + ((const struct timeval *) optval)->tv_usec / 1000;
  1127. break;
  1128. case SO_SNDTIMEO:
  1129. sock->send_timeout = ((const struct timeval *) optval)->tv_sec * 1000
  1130. + ((const struct timeval *) optval)->tv_usec / 1000;
  1131. break;
  1132. default:
  1133. LOG_E("AT socket (%d) not support option name : %d.", socket, optname);
  1134. rt_set_errno(EPERM);
  1135. return -1;
  1136. }
  1137. break;
  1138. case IPPROTO_TCP:
  1139. switch (optname)
  1140. {
  1141. case TCP_NODELAY:
  1142. break;
  1143. }
  1144. break;
  1145. default:
  1146. LOG_E("AT socket (%d) not support option level : %d.", socket, level);
  1147. rt_set_errno(EPERM);
  1148. return -1;
  1149. }
  1150. return 0;
  1151. }
  1152. static uint32_t ipstr_atol(const char* nptr)
  1153. {
  1154. uint32_t total = 0;
  1155. char sign = '+';
  1156. /* jump space */
  1157. while (isspace(*nptr))
  1158. {
  1159. ++nptr;
  1160. }
  1161. if (*nptr == '-' || *nptr == '+')
  1162. {
  1163. sign = *nptr++;
  1164. }
  1165. while (isdigit(*nptr))
  1166. {
  1167. total = 10 * total + ((*nptr++) - '0');
  1168. }
  1169. return (sign == '-') ? -total : total;
  1170. }
  1171. /* IP address to unsigned int type */
  1172. static uint32_t ipstr_to_u32(char *ipstr)
  1173. {
  1174. char ipBytes[4] = { 0 };
  1175. uint32_t i;
  1176. for (i = 0; i < 4; i++, ipstr++)
  1177. {
  1178. ipBytes[i] = (char) ipstr_atol(ipstr);
  1179. if ((ipstr = strchr(ipstr, '.')) == RT_NULL)
  1180. {
  1181. break;
  1182. }
  1183. }
  1184. return *(uint32_t *) ipBytes;
  1185. }
  1186. /**
  1187. * @brief resolves a domain name via AT device and returns its IP address.
  1188. * @note function uses static global mutex internally, which will cause multiple AT devices to block and wait while performing DNS resolution.
  1189. * @param name Pointer to a string containing the domain name.
  1190. * @param addr Pointer to a structure where the IP address information is stored.
  1191. * @return int Returns 0 on success or -1/-2 on failure
  1192. * -1: domain failed
  1193. * -2: HOST_NOT_FOUND
  1194. */
  1195. static int _gethostbyname_by_device(const char *name, ip_addr_t *addr)
  1196. {
  1197. static rt_mutex_t at_dlock = RT_NULL;
  1198. struct at_device *device = RT_NULL;
  1199. char ipstr[16] = { 0 };
  1200. size_t idx = 0;
  1201. device = at_device_get_first_initialized();
  1202. if (device == RT_NULL)
  1203. {
  1204. return -1;
  1205. }
  1206. if (!netdev_is_link_up(device->netdev))
  1207. {
  1208. return -1;
  1209. }
  1210. for (idx = 0; idx < strlen(name) && !isalpha(name[idx]); idx++);
  1211. if (idx < strlen(name))
  1212. {
  1213. if (at_dlock == RT_NULL)
  1214. {
  1215. at_dlock = rt_mutex_create("at_dlock", RT_IPC_FLAG_PRIO);
  1216. if (at_dlock == RT_NULL)
  1217. {
  1218. return -1;
  1219. }
  1220. }
  1221. rt_mutex_take(at_dlock, RT_WAITING_FOREVER);
  1222. if (device->class->socket_ops->at_domain_resolve(name, ipstr) < 0)
  1223. {
  1224. rt_mutex_release(at_dlock);
  1225. return -2;
  1226. }
  1227. rt_mutex_release(at_dlock);
  1228. }
  1229. else
  1230. {
  1231. strncpy(ipstr, name, strlen(name));
  1232. }
  1233. #if NETDEV_IPV4 && NETDEV_IPV6
  1234. addr.type = IPADDR_TYPE_V4;
  1235. if (inet_aton(ipstr, addr) == 0)
  1236. {
  1237. return -1;
  1238. }
  1239. #elif NETDEV_IPV4
  1240. if (inet_aton(ipstr, addr) == 0)
  1241. {
  1242. return -1;
  1243. }
  1244. #elif NETDEV_IPV6
  1245. #error "not support IPV6."
  1246. #endif /* NETDEV_IPV4 && NETDEV_IPV6 */
  1247. return 0;
  1248. }
  1249. struct hostent *at_gethostbyname(const char *name)
  1250. {
  1251. ip_addr_t addr = {0};
  1252. /* buffer variables for at_gethostbyname() */
  1253. static struct hostent s_hostent;
  1254. static char *s_aliases;
  1255. static ip_addr_t s_hostent_addr;
  1256. static ip_addr_t *s_phostent_addr[2];
  1257. static char s_hostname[DNS_MAX_NAME_LENGTH + 1];
  1258. if (name == RT_NULL)
  1259. {
  1260. LOG_E("AT gethostbyname input name error!");
  1261. return RT_NULL;
  1262. }
  1263. if (strlen(name) > DNS_MAX_NAME_LENGTH)
  1264. {
  1265. return RT_NULL;
  1266. }
  1267. if (_gethostbyname_by_device(name, &addr) != 0)
  1268. {
  1269. return RT_NULL;
  1270. }
  1271. /* fill hostent structure */
  1272. s_hostent_addr = addr;
  1273. s_phostent_addr[0] = &s_hostent_addr;
  1274. s_phostent_addr[1] = RT_NULL;
  1275. strncpy(s_hostname, name, strlen(name));
  1276. s_hostname[strlen(name)] = 0;
  1277. s_aliases = RT_NULL;
  1278. s_hostent.h_name = s_hostname;
  1279. s_hostent.h_aliases = &s_aliases;
  1280. s_hostent.h_addrtype = AF_AT;
  1281. s_hostent.h_length = sizeof(ip_addr_t);
  1282. s_hostent.h_addr_list = (char**) &s_phostent_addr;
  1283. return &s_hostent;
  1284. }
  1285. int at_gethostbyname_r(const char *name, struct hostent *ret, char *buf, size_t buflen, struct hostent **result, int *h_errnop)
  1286. {
  1287. struct gethostbyname_r_helper
  1288. {
  1289. ip_addr_t *addr_list[2];
  1290. ip_addr_t addr;
  1291. char *aliases;
  1292. };
  1293. char *hostname = RT_NULL;
  1294. int lh_errno = 0;
  1295. int domain_err = 0;
  1296. size_t namelen = 0;
  1297. struct gethostbyname_r_helper *h = RT_NULL;
  1298. if (h_errnop == RT_NULL)
  1299. {
  1300. h_errnop = &lh_errno;
  1301. }
  1302. if ((name == RT_NULL) || (ret == RT_NULL) || (buf == RT_NULL))
  1303. {
  1304. *h_errnop = EINVAL;
  1305. return -1;
  1306. }
  1307. if (result == RT_NULL)
  1308. {
  1309. *h_errnop = EINVAL;
  1310. return -1;
  1311. }
  1312. *result = RT_NULL;
  1313. namelen = strlen(name);
  1314. if (buflen < (sizeof(struct gethostbyname_r_helper) + (namelen + 1)))
  1315. {
  1316. *h_errnop = ERANGE;
  1317. return -1;
  1318. }
  1319. h = (struct gethostbyname_r_helper *)buf;
  1320. hostname = ((char *)h) + sizeof(struct gethostbyname_r_helper);
  1321. domain_err = _gethostbyname_by_device(name, &h->addr);
  1322. if (domain_err != 0)
  1323. {
  1324. if (domain_err == -2)
  1325. {
  1326. *h_errnop = HOST_NOT_FOUND;
  1327. }
  1328. *h_errnop = NO_DATA;
  1329. return -1;
  1330. }
  1331. rt_memcpy(hostname, name, namelen);
  1332. hostname[namelen] = 0;
  1333. h->addr_list[0] = &h->addr;
  1334. h->addr_list[1] = NULL;
  1335. h->aliases = NULL;
  1336. ret->h_name = hostname;
  1337. ret->h_aliases = &h->aliases;
  1338. ret->h_addrtype = AF_INET;
  1339. ret->h_length = sizeof(ip_addr_t);
  1340. ret->h_addr_list = (char **)&h->addr_list;
  1341. *result = ret;
  1342. return 0;
  1343. }
  1344. int at_getaddrinfo(const char *nodename, const char *servname,
  1345. const struct addrinfo *hints, struct addrinfo **res)
  1346. {
  1347. int port_nr = 0;
  1348. ip_addr_t addr = {0};
  1349. struct addrinfo *ai;
  1350. struct sockaddr_storage *sa;
  1351. size_t total_size = 0;
  1352. size_t namelen = 0;
  1353. int ai_family = 0;
  1354. if (res == RT_NULL)
  1355. {
  1356. return EAI_FAIL;
  1357. }
  1358. *res = RT_NULL;
  1359. if ((nodename == RT_NULL) && (servname == RT_NULL))
  1360. {
  1361. return EAI_NONAME;
  1362. }
  1363. if (hints != RT_NULL)
  1364. {
  1365. ai_family = hints->ai_family;
  1366. if (hints->ai_family != AF_AT && hints->ai_family != AF_INET && hints->ai_family != AF_UNSPEC)
  1367. {
  1368. return EAI_FAMILY;
  1369. }
  1370. }
  1371. else
  1372. {
  1373. ai_family = AF_UNSPEC;
  1374. }
  1375. if (servname != RT_NULL)
  1376. {
  1377. /* service name specified: convert to port number */
  1378. port_nr = atoi(servname);
  1379. if ((port_nr <= 0) || (port_nr > 0xffff))
  1380. {
  1381. return EAI_SERVICE;
  1382. }
  1383. }
  1384. if (nodename != RT_NULL)
  1385. {
  1386. /* service location specified, try to resolve */
  1387. if ((hints != RT_NULL) && (hints->ai_flags & AI_NUMERICHOST))
  1388. {
  1389. if (ai_family == AF_AT || ai_family == AF_INET)
  1390. {
  1391. return EAI_NONAME;
  1392. }
  1393. /* no DNS lookup, just parse for an address string */
  1394. if (!inet_aton(nodename, &addr))
  1395. {
  1396. return EAI_NONAME;
  1397. }
  1398. }
  1399. else
  1400. {
  1401. int domain_err = 0;
  1402. domain_err = _gethostbyname_by_device(nodename, &addr);
  1403. if (domain_err != 0)
  1404. {
  1405. if (domain_err == -2)
  1406. {
  1407. return HOST_NOT_FOUND;
  1408. }
  1409. return NO_DATA;
  1410. }
  1411. }
  1412. }
  1413. else
  1414. {
  1415. /* service location specified, use loopback address */
  1416. inet_aton("127.0.0.1", &addr);
  1417. }
  1418. total_size = sizeof(struct addrinfo) + sizeof(struct sockaddr_storage);
  1419. if (nodename != RT_NULL)
  1420. {
  1421. namelen = strlen(nodename);
  1422. if (namelen == 0 || namelen > DNS_MAX_NAME_LENGTH)
  1423. {
  1424. /* invalid name length */
  1425. return EAI_FAIL;
  1426. }
  1427. total_size += namelen + 1;
  1428. }
  1429. /* If this fails, please report to lwip-devel! :-) */
  1430. if (total_size > sizeof(struct addrinfo) + sizeof(struct sockaddr_storage) + DNS_MAX_NAME_LENGTH + 1)
  1431. {
  1432. return EAI_FAIL;
  1433. }
  1434. ai = (struct addrinfo *) rt_malloc(total_size);
  1435. if (ai == RT_NULL)
  1436. {
  1437. return EAI_MEMORY;
  1438. }
  1439. rt_memset(ai, RT_NULL, total_size);
  1440. /* cast through void* to get rid of alignment warnings */
  1441. sa = (struct sockaddr_storage *) (void *) ((uint8_t *) ai + sizeof(struct addrinfo));
  1442. struct sockaddr_in *sa4 = (struct sockaddr_in *) sa;
  1443. /* set up sockaddr */
  1444. #if NETDEV_IPV4 && NETDEV_IPV6
  1445. sa4->sin_addr.s_addr = addr.u_addr.ip4.addr;
  1446. sa4->type = IPADDR_TYPE_V4;
  1447. #elif NETDEV_IPV4
  1448. sa4->sin_addr.s_addr = addr.addr;
  1449. #elif NETDEV_IPV6
  1450. #error "not support IPV6."
  1451. #endif /* NETDEV_IPV4 && NETDEV_IPV6 */
  1452. sa4->sin_family = AF_INET;
  1453. sa4->sin_len = sizeof(struct sockaddr_in);
  1454. sa4->sin_port = htons((uint16_t)port_nr);
  1455. ai->ai_family = AF_INET;
  1456. /* set up addrinfo */
  1457. if (hints != RT_NULL)
  1458. {
  1459. /* copy socktype & protocol from hints if specified */
  1460. ai->ai_socktype = hints->ai_socktype;
  1461. ai->ai_protocol = hints->ai_protocol;
  1462. }
  1463. if (nodename != RT_NULL)
  1464. {
  1465. /* copy nodename to canonname if specified */
  1466. ai->ai_canonname = ((char *) ai + sizeof(struct addrinfo) + sizeof(struct sockaddr_storage));
  1467. rt_memcpy(ai->ai_canonname, nodename, namelen);
  1468. ai->ai_canonname[namelen] = 0;
  1469. }
  1470. ai->ai_addrlen = sizeof(struct sockaddr_storage);
  1471. ai->ai_addr = (struct sockaddr *) sa;
  1472. *res = ai;
  1473. return 0;
  1474. }
  1475. void at_freeaddrinfo(struct addrinfo *ai)
  1476. {
  1477. struct addrinfo *next;
  1478. while (ai != NULL)
  1479. {
  1480. next = ai->ai_next;
  1481. rt_free(ai);
  1482. ai = next;
  1483. }
  1484. }
  1485. #endif /* AT_USING_SOCKET */