w5500.c 54 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551155215531554155515561557155815591560156115621563156415651566156715681569157015711572157315741575157615771578157915801581158215831584158515861587158815891590159115921593159415951596159715981599160016011602160316041605160616071608160916101611161216131614161516161617161816191620162116221623162416251626162716281629163016311632163316341635163616371638163916401641164216431644164516461647164816491650165116521653165416551656165716581659166016611662166316641665166616671668166916701671167216731674167516761677167816791680168116821683168416851686168716881689169016911692169316941695169616971698169917001701170217031704170517061707170817091710171117121713171417151716171717181719172017211722172317241725172617271728172917301731173217331734173517361737173817391740174117421743174417451746174717481749175017511752175317541755175617571758175917601761176217631764176517661767176817691770177117721773177417751776177717781779178017811782178317841785178617871788178917901791179217931794179517961797179817991800180118021803180418051806180718081809181018111812181318141815181618171818181918201821182218231824182518261827
  1. #include "platform_def.h"
  2. #include "luat_base.h"
  3. #include "luat_spi.h"
  4. #ifdef LUAT_USE_W5500
  5. #include "luat_rtos.h"
  6. #include "luat_zbuff.h"
  7. #include "luat_gpio.h"
  8. #include "w5500_def.h"
  9. #include "luat_network_adapter.h"
  10. #include "dhcp_def.h"
  11. #include "dns_def.h"
  12. extern void DBG_Printf(const char* format, ...);
  13. extern void DBG_HexPrintf(void *Data, unsigned int len);
  14. #if 0
  15. #define DBG(x,y...)
  16. #define DBG_ERR(x,y...) DBG_Printf("%s %d:"x"\r\n", __FUNCTION__,__LINE__,##y)
  17. #else
  18. #define DBG(x,y...) DBG_Printf("%s %d:"x"\r\n", __FUNCTION__,__LINE__,##y)
  19. #define DBG_ERR(x,y...) DBG_Printf("%s %d:"x"\r\n", __FUNCTION__,__LINE__,##y)
  20. #endif
  21. #define W5500_LOCK OS_LOCK
  22. #define W5500_UNLOCK OS_UNLOCK
  23. #define socket_index(n) (n << 5)
  24. #define common_reg (0)
  25. #define socket_reg (1 << 3)
  26. #define socket_tx (2 << 3)
  27. #define socket_rx (3 << 3)
  28. #define is_write (1 << 2)
  29. #define MAX_SOCK_NUM 8
  30. #define SYS_SOCK_ID 0
  31. #define MR_RST 0x80 /**< reset */
  32. #define MR_WOL 0x20 /**< Wake on Lan */
  33. #define MR_PB 0x10 /**< ping block */
  34. #define MR_PPPOE 0x08 /**< enable pppoe */
  35. #define MR_UDP_FARP 0x02 /**< enbale FORCE ARP */
  36. #define IR_CONFLICT 0x80 /**< check ip confict */
  37. #define IR_UNREACH 0x40 /**< get the destination unreachable message in UDP sending */
  38. #define IR_PPPoE 0x20 /**< get the PPPoE close message */
  39. #define IR_MAGIC 0x10 /**< get the magic packet interrupt */
  40. #define Sn_MR_CLOSE 0x00 /**< unused socket */
  41. #define Sn_MR_TCP 0x01 /**< TCP */
  42. #define Sn_MR_UDP 0x02 /**< UDP */
  43. #define Sn_MR_IPRAW 0x03 /**< IP LAYER RAW SOCK */
  44. #define Sn_MR_MACRAW 0x04 /**< MAC LAYER RAW SOCK */
  45. #define Sn_MR_PPPOE 0x05 /**< PPPoE */
  46. #define Sn_MR_UCASTB 0x10 /**< Unicast Block in UDP Multicating*/
  47. #define Sn_MR_ND 0x20 /**< No Delayed Ack(TCP) flag */
  48. #define Sn_MR_MC 0x20 /**< Multicast IGMP (UDP) flag */
  49. #define Sn_MR_BCASTB 0x40 /**< Broadcast blcok in UDP Multicating */
  50. #define Sn_MR_MULTI 0x80 /**< support UDP Multicating */
  51. #define Sn_MR_MIP6N 0x10 /**< IPv6 packet Block */
  52. #define Sn_MR_MMB 0x20 /**< IPv4 Multicasting Block */
  53. //#define Sn_MR_BCASTB 0x40 /**< Broadcast blcok */
  54. #define Sn_MR_MFEN 0x80 /**< support MAC filter enable */
  55. #define Sn_CR_OPEN 0x01 /**< initialize or open socket */
  56. #define Sn_CR_LISTEN 0x02 /**< wait connection request in tcp mode(Server mode) */
  57. #define Sn_CR_CONNECT 0x04 /**< send connection request in tcp mode(Client mode) */
  58. #define Sn_CR_DISCON 0x08 /**< send closing reqeuset in tcp mode */
  59. #define Sn_CR_CLOSE 0x10 /**< close socket */
  60. #define Sn_CR_SEND 0x20 /**< update txbuf pointer, send data */
  61. #define Sn_CR_SEND_MAC 0x21 /**< send data with MAC address, so without ARP process */
  62. #define Sn_CR_SEND_KEEP 0x22 /**< send keep alive message */
  63. #define Sn_CR_RECV 0x40 /**< update rxbuf pointer, recv data */
  64. #define Sn_IR_SEND_OK 0x10 /**< complete sending */
  65. #define Sn_IR_TIMEOUT 0x08 /**< assert timeout */
  66. #define Sn_IR_RECV 0x04 /**< receiving data */
  67. #define Sn_IR_DISCON 0x02 /**< closed socket */
  68. #define Sn_IR_CON 0x01 /**< established connection */
  69. #define SOCK_CLOSED 0x00 /**< closed */
  70. #define SOCK_INIT 0x13 /**< init state */
  71. #define SOCK_LISTEN 0x14 /**< listen state */
  72. #define SOCK_SYNSENT 0x15 /**< connection state */
  73. #define SOCK_SYNRECV 0x16 /**< connection state */
  74. #define SOCK_ESTABLISHED 0x17 /**< success to connect */
  75. #define SOCK_FIN_WAIT 0x18 /**< closing state */
  76. #define SOCK_CLOSING 0x1A /**< closing state */
  77. #define SOCK_TIME_WAIT 0x1B /**< closing state */
  78. #define SOCK_CLOSE_WAIT 0x1C /**< closing state */
  79. #define SOCK_LAST_ACK 0x1D /**< closing state */
  80. #define SOCK_UDP 0x22 /**< udp socket */
  81. #define SOCK_IPRAW 0x32 /**< ip raw mode socket */
  82. #define SOCK_MACRAW 0x42 /**< mac raw mode socket */
  83. #define SOCK_PPPOE 0x5F /**< pppoe socket */
  84. #define SOCK_BUF_LEN (20 * 1024)
  85. enum
  86. {
  87. W5500_COMMON_MR,
  88. W5500_COMMON_GAR0,
  89. W5500_COMMON_SUBR0 = 5,
  90. W5500_COMMON_MAC0 = 9,
  91. W5500_COMMON_IP0 = 0x0f,
  92. W5500_COMMON_INTLEVEL0 = 0x13,
  93. W5500_COMMON_IR = 0x15,
  94. W5500_COMMON_IMR,
  95. W5500_COMMON_SOCKET_IR,
  96. W5500_COMMON_SOCKET_IMR,
  97. W5500_COMMON_SOCKET_RTR0,
  98. W5500_COMMON_SOCKET_RCR = 0x1b,
  99. W5500_COMMON_PPP,
  100. W5500_COMMON_UIPR0 = 0x28,
  101. W5500_COMMON_UPORT0 = 0x2c,
  102. W5500_COMMON_PHY = 0x2e,
  103. W5500_COMMON_VERSIONR = 0x39,
  104. W5500_COMMON_QTY,
  105. W5500_SOCKET_MR = 0,
  106. W5500_SOCKET_CR,
  107. W5500_SOCKET_IR,
  108. W5500_SOCKET_SR,
  109. W5500_SOCKET_SOURCE_PORT0,
  110. W5500_SOCKET_DEST_MAC0 = 0x06,
  111. W5500_SOCKET_DEST_IP0 = 0x0C,
  112. W5500_SOCKET_DEST_PORT0 = 0x10,
  113. W5500_SOCKET_SEGMENT0 = 0x12,
  114. W5500_SOCKET_TOS = 0x15,
  115. W5500_SOCKET_TTL,
  116. W5500_SOCKET_RX_MEM_SIZE = 0x1e,
  117. W5500_SOCKET_TX_MEM_SIZE,
  118. W5500_SOCKET_TX_FREE_SIZE0 = 0x20,
  119. W5500_SOCKET_TX_READ_POINT0 = 0x22,
  120. W5500_SOCKET_TX_WRITE_POINT0 = 0x24,
  121. W5500_SOCKET_RX_SIZE0 = 0x26,
  122. W5500_SOCKET_RX_READ_POINT0 = 0x28,
  123. W5500_SOCKET_RX_WRITE_POINT0 = 0x2A,
  124. W5500_SOCKET_IMR = 0x2C,
  125. W5500_SOCKET_IP_HEAD_FRAG_VALUE0,
  126. W5500_SOCKET_KEEP_TIME = 0x2f,
  127. W5500_SOCKET_QTY,
  128. EV_W5500_IRQ = USER_EVENT_ID_START + 1,
  129. EV_W5500_LINK,
  130. //以下event的顺序不能变,新增event请在上方添加
  131. EV_W5500_SOCKET_TX,
  132. EV_W5500_SOCKET_CONNECT,
  133. EV_W5500_SOCKET_CLOSE,
  134. EV_W5500_SOCKET_LISTEN,
  135. EV_W5500_SOCKET_DNS,
  136. EV_W5500_RE_INIT,
  137. EV_W5500_REG_OP,
  138. W5500_SOCKET_OFFLINE = 0,
  139. W5500_SOCKET_CONFIG,
  140. W5500_SOCKET_CONNECT,
  141. W5500_SOCKET_ONLINE,
  142. W5500_SOCKET_CLOSING,
  143. };
  144. typedef struct
  145. {
  146. llist_head node;
  147. uint64_t tag; //考虑到socket复用的问题,必须有tag来做比对
  148. luat_ip_addr_t ip;
  149. uint8_t *data;
  150. uint32_t read_pos;
  151. uint32_t len;
  152. uint16_t port;
  153. uint8_t is_sending;
  154. }socket_data_t;
  155. typedef struct
  156. {
  157. socket_ctrl_t socket[MAX_SOCK_NUM];
  158. dhcp_client_info_t dhcp_client;
  159. dns_client_t dns_client;
  160. uint64_t last_tx_time;
  161. uint64_t tag;
  162. CBFuncEx_t socket_cb;
  163. void *user_data;
  164. void *task_handle;
  165. uint32_t static_ip; //大端格式存放
  166. uint32_t static_submask; //大端格式存放
  167. uint32_t static_gateway; //大端格式存放
  168. uint16_t RTR;
  169. uint8_t RCR;
  170. uint8_t force_arp;
  171. uint8_t auto_speed;
  172. uint8_t spi_id;
  173. uint8_t cs_pin;
  174. uint8_t rst_pin;
  175. uint8_t irq_pin;
  176. uint8_t link_pin;
  177. uint8_t speed_status;
  178. uint8_t link_ready;
  179. uint8_t ip_ready;
  180. uint8_t network_ready;
  181. uint8_t inter_error;
  182. uint8_t device_on;
  183. uint8_t last_udp_send_ok;
  184. uint8_t rx_buf[2048 + 8];
  185. uint8_t tx_buf[2048 + 8];
  186. uint8_t mac[6];
  187. uint8_t next_socket_index;
  188. }w5500_ctrl_t;
  189. static w5500_ctrl_t *prv_w5500_ctrl;
  190. static void w5500_ip_state(w5500_ctrl_t *w5500, uint8_t check_state);
  191. static void w5500_check_dhcp(w5500_ctrl_t *w5500);
  192. static void w5500_init_reg(w5500_ctrl_t *w5500);
  193. static int w5500_del_data_cache(void *p, void *u)
  194. {
  195. socket_data_t *pdata = (socket_data_t *)p;
  196. free(pdata->data);
  197. return LIST_DEL;
  198. }
  199. static int w5500_next_data_cache(void *p, void *u)
  200. {
  201. socket_ctrl_t *socket = (socket_ctrl_t *)u;
  202. socket_data_t *pdata = (socket_data_t *)p;
  203. if (socket->tag != pdata->tag)
  204. {
  205. DBG("tag error");
  206. free(pdata->data);
  207. return LIST_DEL;
  208. }
  209. return LIST_FIND;
  210. }
  211. static int32_t w5500_irq(int pin, void *args)
  212. {
  213. w5500_ctrl_t *w5500 = (w5500_ctrl_t *)args;
  214. if ((pin & 0x00ff) == w5500->irq_pin)
  215. {
  216. platform_send_event(w5500->task_handle, EV_W5500_IRQ, 0, 0, 0);
  217. }
  218. if ((pin & 0x00ff) == w5500->link_pin)
  219. {
  220. platform_send_event(w5500->task_handle, EV_W5500_LINK, 0, 0, 0);
  221. }
  222. }
  223. static void w5500_callback_to_nw_task(w5500_ctrl_t *w5500, uint32_t event_id, uint32_t param1, uint32_t param2, uint32_t param3)
  224. {
  225. luat_network_cb_param_t param = {.tag = 0, .param = w5500->user_data};
  226. OS_EVENT event = { .ID = event_id, .Param1 = param1, .Param2 = param2, .Param3 = param3};
  227. if (event_id > EV_NW_DNS_RESULT)
  228. {
  229. event.Param3 = prv_w5500_ctrl->socket[param1].param;
  230. param.tag = prv_w5500_ctrl->socket[param1].tag;
  231. }
  232. w5500->socket_cb(&event, &param);
  233. }
  234. static void w5500_xfer(w5500_ctrl_t *w5500, uint16_t address, uint8_t ctrl, uint8_t *data, uint32_t len)
  235. {
  236. BytesPutBe16(w5500->tx_buf, address);
  237. w5500->tx_buf[2] = ctrl;
  238. if (data && len)
  239. {
  240. memcpy(w5500->tx_buf + 3, data, len);
  241. }
  242. luat_gpio_set(w5500->cs_pin, 0);
  243. luat_spi_transfer(w5500->spi_id, w5500->tx_buf, len + 3, w5500->rx_buf, len + 3);
  244. luat_gpio_set(w5500->cs_pin, 1);
  245. if (data && len)
  246. {
  247. memcpy(data, w5500->rx_buf + 3, len);
  248. }
  249. }
  250. static uint8_t w5500_socket_state(w5500_ctrl_t *w5500, uint8_t socket_id)
  251. {
  252. uint8_t retry = 0;
  253. uint8_t temp[4];
  254. do
  255. {
  256. w5500_xfer(w5500, W5500_SOCKET_MR, socket_index(socket_id)|socket_reg, temp, 4);
  257. if (temp[W5500_SOCKET_MR] == 0xff) //模块读不到了
  258. {
  259. w5500->device_on = 0;
  260. return 0;
  261. }
  262. retry++;
  263. }while(temp[W5500_SOCKET_CR] && (retry < 10));
  264. if (retry >= 10)
  265. {
  266. w5500->inter_error++;
  267. DBG_ERR("check too much times, error %d", w5500->inter_error);
  268. }
  269. return temp[W5500_SOCKET_SR];
  270. }
  271. static void w5500_socket_disconnect(w5500_ctrl_t *w5500, uint8_t socket_id)
  272. {
  273. uint8_t temp;
  274. temp = w5500_socket_state(w5500, socket_id);
  275. if (!w5500->device_on) return;
  276. if (SOCK_CLOSED == temp)
  277. {
  278. w5500->socket[socket_id].state = W5500_SOCKET_OFFLINE;
  279. // DBG("socket %d already closed");
  280. return;
  281. }
  282. // if ((temp >= SOCK_FIN_WAIT) && (temp <= SOCK_LAST_ACK))
  283. // {
  284. // w5500->socket[socket_id].state = W5500_SOCKET_CLOSING;
  285. // DBG("socket %d is closing");
  286. // return;
  287. //
  288. // }
  289. temp = Sn_CR_DISCON;
  290. w5500_xfer(w5500, W5500_SOCKET_CR, socket_index(socket_id)|socket_reg|is_write, &temp, 1);
  291. w5500->socket[socket_id].state = W5500_SOCKET_CLOSING;
  292. }
  293. static void w5500_socket_close(w5500_ctrl_t *w5500, uint8_t socket_id)
  294. {
  295. uint8_t temp;
  296. temp = w5500_socket_state(w5500, socket_id);
  297. if (!w5500->device_on) return;
  298. //
  299. // if (SOCK_CLOSED == temp)
  300. // {
  301. // w5500->socket[socket_id].state = W5500_SOCKET_OFFLINE;
  302. //// DBG("socket %d already closed");
  303. // return;
  304. // }
  305. temp = Sn_CR_CLOSE;
  306. w5500_xfer(w5500, W5500_SOCKET_CR, socket_index(socket_id)|socket_reg|is_write, &temp, 1);
  307. w5500->socket[socket_id].state = W5500_SOCKET_OFFLINE;
  308. }
  309. static int w5500_socket_config(w5500_ctrl_t *w5500, uint8_t socket_id, uint8_t is_tcp, uint16_t local_port)
  310. {
  311. uint8_t delay_cnt;
  312. uint8_t temp;
  313. temp = w5500_socket_state(w5500, socket_id);
  314. if (!w5500->device_on) return -1;
  315. if (SOCK_CLOSED != temp)
  316. {
  317. DBG_ERR("socket %d not closed state %x", socket_id, temp);
  318. return -1;
  319. }
  320. uint8_t cmd[32];
  321. uint16_t wtemp;
  322. for(temp = 0; temp < 3; temp++)
  323. {
  324. cmd[W5500_SOCKET_MR] = is_tcp?Sn_MR_TCP:Sn_MR_UDP;
  325. cmd[W5500_SOCKET_CR] = 0;
  326. cmd[W5500_SOCKET_IR] = 0xff;
  327. BytesPutBe16(&cmd[W5500_SOCKET_SOURCE_PORT0], local_port);
  328. BytesPutLe32(&cmd[W5500_SOCKET_DEST_IP0], 0xffffffff);
  329. BytesPutBe16(&cmd[W5500_SOCKET_DEST_PORT0], 0);
  330. BytesPutBe16(&cmd[W5500_SOCKET_SEGMENT0], is_tcp?1460:1472);
  331. w5500_xfer(w5500, W5500_SOCKET_MR, socket_index(socket_id)|socket_reg|is_write, cmd, W5500_SOCKET_TOS - 1);
  332. w5500_xfer(w5500, W5500_SOCKET_MR, socket_index(socket_id)|socket_reg, cmd, W5500_SOCKET_TOS - 1);
  333. wtemp = BytesGetBe16(&cmd[W5500_SOCKET_SOURCE_PORT0]);
  334. if (wtemp != local_port)
  335. {
  336. DBG_ERR("error port %u %u", wtemp, local_port);
  337. }
  338. else
  339. {
  340. goto W5500_SOCKET_CONFIG_START;
  341. }
  342. }
  343. return -1;
  344. W5500_SOCKET_CONFIG_START:
  345. cmd[0] = Sn_CR_OPEN;
  346. w5500_xfer(w5500, W5500_SOCKET_CR, socket_index(socket_id)|socket_reg|is_write, cmd, 1);
  347. do
  348. {
  349. temp = w5500_socket_state(w5500, socket_id);
  350. if (!w5500->device_on) return -1;
  351. delay_cnt++;
  352. }while((temp != SOCK_INIT) && (temp != SOCK_UDP) && (delay_cnt < 100));
  353. if (delay_cnt >= 100)
  354. {
  355. w5500->inter_error++;
  356. DBG_ERR("socket %d config timeout, error %d", socket_id, w5500->inter_error);
  357. return -1;
  358. }
  359. w5500->socket[socket_id].state = is_tcp?W5500_SOCKET_CONFIG:W5500_SOCKET_ONLINE;
  360. return 0;
  361. }
  362. static int w5500_socket_connect(w5500_ctrl_t *w5500, uint8_t socket_id, uint8_t is_listen, uint32_t remote_ip, uint16_t remote_port)
  363. {
  364. uint32_t ip;
  365. uint16_t port;
  366. uint8_t delay_cnt;
  367. uint8_t temp;
  368. uint8_t cmd[16];
  369. temp = w5500_socket_state(w5500, socket_id);
  370. if (!w5500->device_on) return -1;
  371. if ((temp != SOCK_INIT) && (temp != SOCK_UDP))
  372. {
  373. DBG("socket %d not config state %x", socket_id, temp);
  374. return -1;
  375. }
  376. // BytesPutLe32(cmd, remote_ip);
  377. // DBG("%02d.%02d.%02d,%02d, %u, %d", cmd[0], cmd[1], cmd[2], cmd[3], remote_port, is_listen);
  378. if (!is_listen)
  379. {
  380. // w5500_xfer(w5500, W5500_SOCKET_DEST_IP0, socket_index(socket_id)|socket_reg, cmd, 6);
  381. // ip = BytesGetLe32(cmd);
  382. // port = BytesGetBe16(cmd + 4);
  383. // if (ip != remote_ip || port != remote_port)
  384. {
  385. BytesPutLe32(cmd, remote_ip);
  386. BytesPutBe16(&cmd[W5500_SOCKET_DEST_PORT0 - W5500_SOCKET_DEST_IP0], remote_port);
  387. w5500_xfer(w5500, W5500_SOCKET_DEST_IP0, socket_index(socket_id)|socket_reg|is_write, cmd, 6);
  388. }
  389. }
  390. W5500_SOCKET_CONNECT_START:
  391. if (temp != SOCK_UDP)
  392. {
  393. uint8_t temp = is_listen?Sn_CR_LISTEN:Sn_CR_CONNECT;
  394. w5500_xfer(w5500, W5500_SOCKET_CR, socket_index(socket_id)|socket_reg|is_write, &temp, 1);
  395. w5500->socket[socket_id].state = W5500_SOCKET_CONNECT;
  396. }
  397. return 0;
  398. }
  399. static int w5500_socket_auto_heart(w5500_ctrl_t *w5500, uint8_t socket_id, uint8_t time)
  400. {
  401. uint8_t point[6];
  402. point[0] = time;
  403. w5500_xfer(w5500, W5500_SOCKET_KEEP_TIME, socket_index(socket_id)|socket_reg|is_write, point, 1);
  404. return 0;
  405. }
  406. static int w5500_socket_tx(w5500_ctrl_t *w5500, uint8_t socket_id, uint8_t *data, uint16_t len)
  407. {
  408. uint8_t delay_cnt;
  409. uint8_t temp;
  410. uint8_t point[6];
  411. uint16_t tx_free, tx_point;
  412. temp = w5500_socket_state(w5500, socket_id);
  413. if (!w5500->device_on) return -1;
  414. if ((temp != SOCK_ESTABLISHED) && (temp != SOCK_UDP))
  415. {
  416. DBG("socket %d not online state %x", socket_id, temp);
  417. return -1;
  418. }
  419. w5500->socket[socket_id].state = W5500_SOCKET_ONLINE;
  420. if (!data || !len)
  421. {
  422. point[0] = Sn_CR_SEND_KEEP;
  423. w5500_xfer(w5500, W5500_SOCKET_CR, socket_index(socket_id)|socket_reg|is_write, point, 1);
  424. }
  425. w5500_xfer(w5500, W5500_SOCKET_TX_FREE_SIZE0, socket_index(socket_id)|socket_reg, point, 6);
  426. tx_free = BytesGetBe16(point);
  427. tx_point = BytesGetBe16(point + 4);
  428. // if (tx_free != 2048)
  429. // {
  430. // DBG("%d,0x%04x,%u,%u", socket_id, tx_point, len,tx_free);
  431. // }
  432. // DBG_HexPrintf(data, len);
  433. if (len > tx_free)
  434. {
  435. len = tx_free;
  436. }
  437. w5500->last_tx_time = GetSysTickMS();
  438. w5500_xfer(w5500, tx_point, socket_index(socket_id)|socket_tx|is_write, data, len);
  439. tx_point += len;
  440. BytesPutBe16(point, tx_point);
  441. w5500_xfer(w5500, W5500_SOCKET_TX_WRITE_POINT0, socket_index(socket_id)|socket_reg|is_write, point, 2);
  442. point[0] = Sn_CR_SEND;
  443. w5500_xfer(w5500, W5500_SOCKET_CR, socket_index(socket_id)|socket_reg|is_write, point, 1);
  444. return len;
  445. }
  446. static int w5500_socket_rx(w5500_ctrl_t *w5500, uint8_t socket_id, uint8_t *data, uint16_t len)
  447. {
  448. uint8_t delay_cnt;
  449. uint8_t temp;
  450. uint8_t point[4];
  451. uint16_t rx_size, rx_point;
  452. temp = w5500_socket_state(w5500, socket_id);
  453. if (!w5500->device_on) return -1;
  454. if ((temp < SOCK_ESTABLISHED) || (temp > SOCK_UDP))
  455. {
  456. DBG("socket %d not config state %x", socket_id, temp);
  457. return -1;
  458. }
  459. w5500->socket[socket_id].state = W5500_SOCKET_ONLINE;
  460. w5500_xfer(w5500, W5500_SOCKET_RX_SIZE0, socket_index(socket_id)|socket_reg, point, 4);
  461. rx_size = BytesGetBe16(point);
  462. rx_point = BytesGetBe16(point + 2);
  463. // DBG("%d,0x%04x,%u", socket_id, rx_point, rx_size);
  464. if (!rx_size) return 0;
  465. if (rx_size < len)
  466. {
  467. len = rx_size;
  468. }
  469. w5500_xfer(w5500, rx_point, socket_index(socket_id)|socket_rx, data, len);
  470. rx_point += len;
  471. BytesPutBe16(point, rx_point);
  472. w5500_xfer(w5500, W5500_SOCKET_RX_READ_POINT0, socket_index(socket_id)|socket_reg|is_write, point, 2);
  473. point[0] = Sn_CR_RECV;
  474. w5500_xfer(w5500, W5500_SOCKET_CR, socket_index(socket_id)|socket_reg|is_write, point, 1);
  475. return len;
  476. }
  477. static void w5500_nw_state(w5500_ctrl_t *w5500)
  478. {
  479. int i;
  480. PV_Union uIP;
  481. if (w5500->link_ready && w5500->ip_ready)
  482. {
  483. if (!w5500->network_ready)
  484. {
  485. w5500->network_ready = 1;
  486. dns_clear(&w5500->dns_client);
  487. w5500->socket[0].tx_wait_size = 0; //dns可以继续发送了
  488. w5500_callback_to_nw_task(w5500, EV_NW_STATE, 0, 1, 0);
  489. DBG("network ready");
  490. for(i = 0; i < MAX_DNS_SERVER; i++)
  491. {
  492. if (w5500->dns_client.dns_server[i].is_ipv6 != 0xff)
  493. {
  494. uIP.u32 = w5500->dns_client.dns_server[i].ipv4;
  495. DBG("DNS%d:%d.%d.%d.%d",i, uIP.u8[0], uIP.u8[1], uIP.u8[2], uIP.u8[3]);
  496. }
  497. }
  498. }
  499. }
  500. else
  501. {
  502. if (w5500->network_ready)
  503. {
  504. w5500->network_ready = 0;
  505. dns_clear(&w5500->dns_client);
  506. w5500_callback_to_nw_task(w5500, EV_NW_STATE, 0, 0, 0);
  507. DBG("network not ready");
  508. for(i = 0; i < MAX_SOCK_NUM; i++)
  509. {
  510. w5500->socket[i].tx_wait_size = 0;
  511. // llist_traversal(&w5500->socket[i].tx_head, w5500_del_data_cache, NULL);
  512. // llist_traversal(&w5500->socket[i].rx_head, w5500_del_data_cache, NULL);
  513. }
  514. }
  515. }
  516. }
  517. static void w5500_check_dhcp(w5500_ctrl_t *w5500)
  518. {
  519. if (w5500->static_ip) return;
  520. if (DHCP_STATE_CHECK == w5500->dhcp_client.state)
  521. {
  522. w5500->dhcp_client.state = DHCP_STATE_WAIT_LEASE_P1;
  523. uint8_t temp[24];
  524. PV_Union uIP;
  525. memset(temp, 0, sizeof(temp));
  526. temp[0] = w5500->force_arp?MR_UDP_FARP:0;
  527. BytesPutLe32(&temp[W5500_COMMON_GAR0], w5500->dhcp_client.gateway);
  528. BytesPutLe32(&temp[W5500_COMMON_SUBR0], w5500->dhcp_client.submask);
  529. BytesPutLe32(&temp[W5500_COMMON_IP0], w5500->dhcp_client.ip);
  530. memcpy(&temp[W5500_COMMON_MAC0], w5500->dhcp_client.mac, 6);
  531. w5500_xfer(w5500, W5500_COMMON_MR, is_write, temp, W5500_COMMON_INTLEVEL0);
  532. w5500->dhcp_client.discover_cnt = 0;
  533. uIP.u32 = w5500->dhcp_client.ip;
  534. DBG("动态IP:%d.%d.%d.%d", uIP.u8[0], uIP.u8[1], uIP.u8[2], uIP.u8[3]);
  535. uIP.u32 = w5500->dhcp_client.submask;
  536. DBG("子网掩码:%d.%d.%d.%d", uIP.u8[0], uIP.u8[1], uIP.u8[2], uIP.u8[3]);
  537. uIP.u32 = w5500->dhcp_client.gateway;
  538. DBG("网关:%d.%d.%d.%d", uIP.u8[0], uIP.u8[1], uIP.u8[2], uIP.u8[3]);
  539. DBG("租约时间:%u秒", w5500->dhcp_client.lease_time);
  540. int i;
  541. for(i = 0; i < MAX_DNS_SERVER; i++)
  542. {
  543. if (w5500->dns_client.is_static_dns[i])
  544. {
  545. goto PRINT_DNS;
  546. }
  547. }
  548. if (w5500->dhcp_client.dns_server[0])
  549. {
  550. w5500->dns_client.dns_server[0].ipv4 = w5500->dhcp_client.dns_server[0];
  551. w5500->dns_client.dns_server[0].is_ipv6 = 0;
  552. }
  553. if (w5500->dhcp_client.dns_server[1])
  554. {
  555. w5500->dns_client.dns_server[1].ipv4 = w5500->dhcp_client.dns_server[1];
  556. w5500->dns_client.dns_server[1].is_ipv6 = 0;
  557. }
  558. PRINT_DNS:
  559. w5500_ip_state(w5500, 1);
  560. }
  561. if ((!w5500->last_udp_send_ok && w5500->dhcp_client.discover_cnt >= 1) || (w5500->last_udp_send_ok && w5500->dhcp_client.discover_cnt >= 3))
  562. {
  563. DBG("dhcp long time not get ip, reboot w5500");
  564. memset(&w5500->dhcp_client, 0, sizeof(w5500->dhcp_client));
  565. platform_send_event(w5500->task_handle, EV_W5500_RE_INIT, 0, 0, 0);
  566. }
  567. }
  568. static void w5500_link_state(w5500_ctrl_t *w5500, uint8_t check_state)
  569. {
  570. Buffer_Struct tx_msg_buf = {0,0,0};
  571. uint32_t remote_ip;
  572. int result;
  573. if (w5500->link_ready != check_state)
  574. {
  575. DBG("link %d -> %d", w5500->link_ready, check_state);
  576. w5500->link_ready = check_state;
  577. if (w5500->link_ready)
  578. {
  579. if (!w5500->static_ip)
  580. {
  581. w5500_ip_state(w5500, 0);
  582. w5500->dhcp_client.state = w5500->dhcp_client.ip?DHCP_STATE_REQUIRE:DHCP_STATE_DISCOVER;
  583. uint8_t temp[1];
  584. temp[0] = MR_UDP_FARP;
  585. w5500_xfer(w5500, W5500_COMMON_MR, is_write, temp, 1);
  586. result = ip4_dhcp_run(&w5500->dhcp_client, NULL, &tx_msg_buf, &remote_ip);
  587. w5500_check_dhcp(w5500);
  588. if (tx_msg_buf.Pos)
  589. {
  590. w5500_socket_connect(w5500, SYS_SOCK_ID, 0, remote_ip, DHCP_SERVER_PORT);
  591. w5500_socket_tx(w5500, SYS_SOCK_ID, tx_msg_buf.Data, tx_msg_buf.Pos);
  592. w5500->last_udp_send_ok = 0;
  593. }
  594. OS_DeInitBuffer(&tx_msg_buf);
  595. }
  596. }
  597. else
  598. {
  599. if (GetSysTickMS() < (w5500->last_tx_time + 1500))
  600. {
  601. w5500->inter_error++;
  602. DBG_ERR("link down too fast, error %u", w5500->inter_error);
  603. }
  604. }
  605. w5500_nw_state(w5500);
  606. }
  607. }
  608. static void w5500_ip_state(w5500_ctrl_t *w5500, uint8_t check_state)
  609. {
  610. if (w5500->ip_ready != check_state)
  611. {
  612. DBG("ip %d -> %d", w5500->ip_ready, check_state);
  613. w5500->ip_ready = check_state;
  614. w5500_nw_state(w5500);
  615. }
  616. }
  617. static void w5500_init_reg(w5500_ctrl_t *w5500)
  618. {
  619. uint8_t temp[64];
  620. luat_gpio_set(w5500->rst_pin, 0);
  621. msleep(5);
  622. luat_gpio_set(w5500->rst_pin, 1);
  623. msleep(10);
  624. w5500->ip_ready = 0;
  625. w5500->network_ready = 0;
  626. if (w5500->static_ip)
  627. {
  628. w5500->dhcp_client.state = DHCP_STATE_NOT_WORK;
  629. }
  630. else
  631. {
  632. if (w5500->auto_speed)
  633. {
  634. w5500->dhcp_client.state = DHCP_STATE_DISCOVER;
  635. }
  636. else
  637. {
  638. if ((w5500->dhcp_client.state == DHCP_STATE_NOT_WORK) || !w5500->dhcp_client.ip)
  639. {
  640. w5500->dhcp_client.state = DHCP_STATE_DISCOVER;
  641. }
  642. else
  643. {
  644. w5500->dhcp_client.state = DHCP_STATE_REQUIRE;
  645. }
  646. }
  647. }
  648. w5500_callback_to_nw_task(w5500, EV_NW_RESET, 0, 0, 0);
  649. luat_gpio_close(w5500->link_pin);
  650. luat_gpio_close(w5500->irq_pin);
  651. w5500_xfer(w5500, W5500_COMMON_MR, 0, temp, W5500_COMMON_QTY);
  652. w5500->device_on = (0x04 == temp[W5500_COMMON_VERSIONR])?1:0;
  653. w5500_link_state(w5500, w5500->device_on?(temp[W5500_COMMON_PHY] & 0x01):0);
  654. temp[W5500_COMMON_MR] = w5500->force_arp?MR_UDP_FARP:0;
  655. if (w5500->static_ip)
  656. {
  657. BytesPutLe32(&temp[W5500_COMMON_GAR0], w5500->static_gateway); //已经是大端格式了不需要转换
  658. BytesPutLe32(&temp[W5500_COMMON_SUBR0], w5500->static_submask); //已经是大端格式了不需要转换
  659. BytesPutLe32(&temp[W5500_COMMON_IP0], w5500->static_ip); //已经是大端格式了不需要转换
  660. }
  661. else if (w5500->dhcp_client.ip)
  662. {
  663. BytesPutLe32(&temp[W5500_COMMON_GAR0], w5500->dhcp_client.gateway);
  664. BytesPutLe32(&temp[W5500_COMMON_SUBR0], w5500->dhcp_client.submask);
  665. BytesPutLe32(&temp[W5500_COMMON_IP0], w5500->dhcp_client.ip);
  666. }
  667. else
  668. {
  669. BytesPutLe32(&temp[W5500_COMMON_GAR0], 0);
  670. BytesPutLe32(&temp[W5500_COMMON_SUBR0], 0);
  671. BytesPutLe32(&temp[W5500_COMMON_IP0], 0);
  672. }
  673. memcpy(&temp[W5500_COMMON_MAC0], w5500->mac, 6);
  674. memcpy(w5500->dhcp_client.mac, &temp[W5500_COMMON_MAC0], 6);
  675. sprintf_(w5500->dhcp_client.name, "airm2m-%02x%02x%02x%02x%02x%02x",
  676. w5500->dhcp_client.mac[0],w5500->dhcp_client.mac[1], w5500->dhcp_client.mac[2],
  677. w5500->dhcp_client.mac[3],w5500->dhcp_client.mac[4], w5500->dhcp_client.mac[5]);
  678. // BytesPutBe16(&temp[W5500_COMMON_SOCKET_RTR0], w5500->RTR);
  679. temp[W5500_COMMON_IMR] = IR_CONFLICT|IR_UNREACH|IR_MAGIC;
  680. temp[W5500_COMMON_SOCKET_IMR] = 0xff;
  681. // temp[W5500_COMMON_SOCKET_RCR] = w5500->RCR;
  682. // DBG_HexPrintf(temp + W5500_COMMON_SOCKET_RTR0, 3);
  683. w5500_xfer(w5500, W5500_COMMON_MR, is_write, temp, W5500_COMMON_QTY);
  684. // memset(temp, 0, sizeof(temp));
  685. // w5500_xfer(w5500, W5500_COMMON_MR, 0, NULL, W5500_COMMON_QTY);
  686. // DBG_HexPrintf(temp, W5500_COMMON_QTY);
  687. w5500_ip_state(w5500, w5500->static_ip?1:0);
  688. luat_gpio_t gpio = {0};
  689. gpio.pin = w5500->irq_pin;
  690. gpio.mode = Luat_GPIO_IRQ;
  691. gpio.pull = Luat_GPIO_PULLUP;
  692. gpio.irq = Luat_GPIO_FALLING;
  693. gpio.irq_cb = w5500_irq;
  694. gpio.irq_args = w5500;
  695. luat_gpio_setup(&gpio);
  696. gpio.pin = w5500->link_pin;
  697. gpio.pull = Luat_GPIO_DEFAULT;
  698. gpio.irq = Luat_GPIO_BOTH;
  699. gpio.irq_cb = w5500_irq;
  700. gpio.irq_args = w5500;
  701. luat_gpio_setup(&gpio);
  702. w5500_socket_auto_heart(w5500, SYS_SOCK_ID, 2);
  703. w5500_socket_config(w5500, SYS_SOCK_ID, 0, DHCP_CLIENT_PORT);
  704. if (w5500->auto_speed)
  705. {
  706. temp[0] = 0x78;
  707. w5500_xfer(w5500, W5500_COMMON_PHY, is_write, temp, 1);
  708. temp[0] = 0x78+ 0x80;
  709. w5500_xfer(w5500, W5500_COMMON_PHY, is_write, temp, 1);
  710. }
  711. w5500->inter_error = 0;
  712. w5500->next_socket_index = 1;
  713. int i;
  714. for(i = 0; i < MAX_DNS_SERVER; i++)
  715. {
  716. if (!w5500->dns_client.is_static_dns[i])
  717. {
  718. w5500->dns_client.dns_server[i].is_ipv6 = 0xff;
  719. }
  720. }
  721. }
  722. static int32_t w5500_dummy_callback(void *pData, void *pParam)
  723. {
  724. return 0;
  725. }
  726. static socket_data_t * w5500_create_data_node(w5500_ctrl_t *w5500, uint8_t socket_id, uint8_t *data, uint32_t len, luat_ip_addr_t *remote_ip, uint16_t remote_port)
  727. {
  728. socket_data_t *p = (socket_data_t *)malloc(sizeof(socket_data_t));
  729. if (p)
  730. {
  731. memset(p, 0, sizeof(socket_data_t));
  732. p->len = len;
  733. p->port = remote_port;
  734. if (remote_ip)
  735. {
  736. p->ip = *remote_ip;
  737. }
  738. else
  739. {
  740. p->ip.is_ipv6 = 0xff;
  741. }
  742. p->tag = w5500->socket[socket_id].tag;
  743. if (data && len)
  744. {
  745. p->data = malloc(len);
  746. if (p->data)
  747. {
  748. memcpy(p->data, data, len);
  749. }
  750. else
  751. {
  752. free(p);
  753. return NULL;
  754. }
  755. }
  756. }
  757. return p;
  758. }
  759. static void w5500_socket_tx_next_data(w5500_ctrl_t *w5500, uint8_t socket_id)
  760. {
  761. W5500_LOCK;
  762. socket_data_t *p = llist_traversal(&w5500->socket[socket_id].tx_head, w5500_next_data_cache, &prv_w5500_ctrl->socket[socket_id]);
  763. W5500_UNLOCK;
  764. if (p)
  765. {
  766. if (!w5500->socket[socket_id].is_tcp)
  767. {
  768. w5500_socket_connect(w5500, socket_id, 0, p->ip.ipv4, p->port);
  769. }
  770. if (p->data && p->len)
  771. {
  772. p->read_pos += w5500_socket_tx(w5500, socket_id, p->data + p->read_pos, p->len - p->read_pos);
  773. p->is_sending = 1;
  774. }
  775. else
  776. {
  777. w5500_socket_tx(w5500, socket_id, NULL, 0);
  778. p->len = 0;
  779. p->read_pos = 0;
  780. p->is_sending = 1;
  781. }
  782. }
  783. }
  784. static int32_t w5500_dns_check_result(void *data, void *param)
  785. {
  786. luat_dns_require_t *require = (luat_dns_require_t *)data;
  787. if (require->result != 0)
  788. {
  789. free(require->uri.Data);
  790. require->uri.Data = NULL;
  791. if (require->result > 0)
  792. {
  793. luat_dns_ip_result *ip_result = zalloc(sizeof(luat_dns_ip_result) * require->result);
  794. int i;
  795. for(i = 0; i < require->result; i++)
  796. {
  797. ip_result[i] = require->ip_result[i];
  798. }
  799. w5500_callback_to_nw_task(param, EV_NW_DNS_RESULT, require->result, ip_result, require->param);
  800. }
  801. else
  802. {
  803. w5500_callback_to_nw_task(param, EV_NW_DNS_RESULT, 0, 0, require->param);
  804. }
  805. return LIST_DEL;
  806. }
  807. else
  808. {
  809. return LIST_PASS;
  810. }
  811. }
  812. static void w5500_dns_tx_next(w5500_ctrl_t *w5500, Buffer_Struct *tx_msg_buf)
  813. {
  814. int i;
  815. if (w5500->socket[SYS_SOCK_ID].tx_wait_size) return;
  816. dns_run(&w5500->dns_client, NULL, tx_msg_buf, &i);
  817. if (tx_msg_buf->Pos)
  818. {
  819. w5500_socket_connect(w5500, SYS_SOCK_ID, 0, w5500->dns_client.dns_server[i].ipv4, DNS_SERVER_PORT);
  820. if (!w5500_socket_tx(w5500, SYS_SOCK_ID, tx_msg_buf->Data, tx_msg_buf->Pos))
  821. {
  822. w5500->socket[SYS_SOCK_ID].tx_wait_size = 1;
  823. }
  824. OS_DeInitBuffer(tx_msg_buf);
  825. llist_traversal(&w5500->dns_client.require_head, w5500_dns_check_result, w5500);
  826. }
  827. }
  828. static void w5500_sys_socket_callback(w5500_ctrl_t *w5500, uint8_t socket_id, uint8_t event)
  829. {
  830. Buffer_Struct rx_buf;
  831. Buffer_Struct msg_buf;
  832. Buffer_Struct tx_msg_buf = {0,0,0};
  833. int result, i;
  834. uint32_t ip;
  835. uint16_t port;
  836. uint16_t len;
  837. socket_data_t *p;
  838. luat_ip_addr_t ip_addr;
  839. switch(event)
  840. {
  841. case Sn_IR_SEND_OK:
  842. if (!socket_id)
  843. {
  844. w5500->last_udp_send_ok = 1;
  845. if (w5500->network_ready)
  846. {
  847. w5500->socket[SYS_SOCK_ID].tx_wait_size = 0;
  848. w5500_dns_tx_next(w5500, &tx_msg_buf);
  849. }
  850. }
  851. else if (w5500->network_ready)
  852. {
  853. W5500_LOCK;
  854. p = llist_traversal(&w5500->socket[socket_id].tx_head, w5500_next_data_cache, &prv_w5500_ctrl->socket[socket_id]);
  855. W5500_UNLOCK;
  856. if (p && !p->is_sending)
  857. {
  858. DBG_ERR("socket %d should sending!", socket_id);
  859. p->read_pos = 0;
  860. }
  861. if (p && (p->read_pos >= p->len))
  862. {
  863. ip = p->len;
  864. W5500_LOCK;
  865. w5500->socket[socket_id].tx_wait_size -= p->len;
  866. llist_del(&p->node);
  867. free(p->data);
  868. free(p);
  869. W5500_UNLOCK;
  870. w5500_callback_to_nw_task(w5500, EV_NW_SOCKET_TX_OK, socket_id, ip, 0);
  871. }
  872. w5500_socket_tx_next_data(w5500, socket_id);
  873. if (llist_empty(&w5500->socket[socket_id].tx_head))
  874. {
  875. w5500->socket[socket_id].tx_wait_size = 0;
  876. }
  877. }
  878. break;
  879. case Sn_IR_RECV:
  880. if (socket_id && (w5500->socket[socket_id].rx_wait_size >= SOCK_BUF_LEN))
  881. {
  882. DBG("socket %d, wait %dbyte", socket_id, w5500->socket[socket_id].rx_wait_size);
  883. w5500_callback_to_nw_task(w5500, EV_NW_SOCKET_RX_FULL, socket_id, 0, 0);
  884. w5500->socket[socket_id].rx_waiting = 1;
  885. break;
  886. }
  887. OS_InitBuffer(&rx_buf, 2048);
  888. result = w5500_socket_rx(w5500, socket_id, rx_buf.Data, rx_buf.MaxLen);
  889. if (result > 0)
  890. {
  891. if (socket_id)
  892. {
  893. if (w5500->socket[socket_id].is_tcp)
  894. {
  895. socket_data_t *p = w5500_create_data_node(w5500, socket_id, rx_buf.Data, result, NULL, 0);
  896. W5500_LOCK;
  897. llist_add_tail(&p->node, &prv_w5500_ctrl->socket[socket_id].rx_head);
  898. prv_w5500_ctrl->socket[socket_id].rx_wait_size += result;
  899. W5500_UNLOCK;
  900. w5500_callback_to_nw_task(w5500, EV_NW_SOCKET_RX_NEW, socket_id, result, 0);
  901. }
  902. else
  903. {
  904. W5500_LOCK;
  905. rx_buf.Pos = 0;
  906. while (rx_buf.Pos < result)
  907. {
  908. ip_addr.ipv4 = BytesGetLe32(rx_buf.Data + rx_buf.Pos);
  909. ip_addr.is_ipv6 = 0;
  910. port = BytesGetBe16(rx_buf.Data + rx_buf.Pos + 4);
  911. len = BytesGetBe16(rx_buf.Data + rx_buf.Pos + 6);
  912. msg_buf.Data = rx_buf.Data + rx_buf.Pos + 8;
  913. msg_buf.MaxLen = len;
  914. socket_data_t *p = w5500_create_data_node(w5500, socket_id, rx_buf.Data + rx_buf.Pos + 8, len, &ip_addr, port);
  915. rx_buf.Pos += 8 + len;
  916. llist_add_tail(&p->node, &prv_w5500_ctrl->socket[socket_id].rx_head);
  917. prv_w5500_ctrl->socket[socket_id].rx_wait_size += len;
  918. }
  919. W5500_UNLOCK;
  920. w5500_callback_to_nw_task(w5500, EV_NW_SOCKET_RX_NEW, socket_id, result, 0);
  921. }
  922. }
  923. else
  924. {
  925. rx_buf.Pos = 0;
  926. while (rx_buf.Pos < result)
  927. {
  928. ip = BytesGetBe32(rx_buf.Data + rx_buf.Pos);
  929. port = BytesGetBe16(rx_buf.Data + rx_buf.Pos + 4);
  930. len = BytesGetBe16(rx_buf.Data + rx_buf.Pos + 6);
  931. msg_buf.Data = rx_buf.Data + rx_buf.Pos + 8;
  932. msg_buf.MaxLen = len;
  933. msg_buf.Pos = 0;
  934. switch(port)
  935. {
  936. case DHCP_SERVER_PORT:
  937. ip4_dhcp_run(&w5500->dhcp_client, &msg_buf, &tx_msg_buf, &ip);
  938. w5500_check_dhcp(w5500);
  939. if (tx_msg_buf.Pos)
  940. {
  941. w5500_socket_connect(w5500, SYS_SOCK_ID, 0, ip, DHCP_SERVER_PORT);
  942. w5500_socket_tx(w5500, SYS_SOCK_ID, tx_msg_buf.Data, tx_msg_buf.Pos);
  943. w5500->last_udp_send_ok = 0;
  944. }
  945. OS_DeInitBuffer(&tx_msg_buf);
  946. break;
  947. case DNS_SERVER_PORT:
  948. dns_run(&w5500->dns_client, &msg_buf, NULL, &i);
  949. llist_traversal(&w5500->dns_client.require_head, w5500_dns_check_result, w5500);
  950. if (!w5500->socket[SYS_SOCK_ID].tx_wait_size)
  951. {
  952. dns_run(&w5500->dns_client, NULL, &tx_msg_buf, &i);
  953. if (tx_msg_buf.Pos)
  954. {
  955. w5500_socket_connect(w5500, SYS_SOCK_ID, 0, w5500->dns_client.dns_server[i].ipv4, DNS_SERVER_PORT);
  956. if (!w5500_socket_tx(w5500, SYS_SOCK_ID, tx_msg_buf.Data, tx_msg_buf.Pos))
  957. {
  958. w5500->socket[SYS_SOCK_ID].tx_wait_size = 1;
  959. }
  960. OS_DeInitBuffer(&tx_msg_buf);
  961. }
  962. }
  963. break;
  964. }
  965. rx_buf.Pos += 8 + len;
  966. }
  967. }
  968. }
  969. OS_DeInitBuffer(&rx_buf);
  970. break;
  971. case Sn_IR_TIMEOUT:
  972. DBG_ERR("socket %d timeout", socket_id);
  973. if (socket_id)
  974. {
  975. w5500_callback_to_nw_task(w5500, EV_NW_SOCKET_ERROR, socket_id, 0, 0);
  976. }
  977. break;
  978. case Sn_IR_CON:
  979. DBG("socket %d connected", socket_id);
  980. w5500_callback_to_nw_task(w5500, EV_NW_SOCKET_CONNECT_OK, socket_id, 0, 0);
  981. break;
  982. case Sn_IR_DISCON:
  983. DBG_ERR("socket %d disconnect", socket_id);
  984. if (w5500_socket_state(w5500, socket_id) != SOCK_CLOSED)
  985. {
  986. w5500_callback_to_nw_task(w5500, EV_NW_SOCKET_REMOTE_CLOSE, socket_id, 0, 0);
  987. }
  988. else
  989. {
  990. w5500_callback_to_nw_task(w5500, EV_NW_SOCKET_CLOSE_OK, socket_id, 0, 0);
  991. }
  992. break;
  993. default:
  994. break;
  995. }
  996. }
  997. static void w5500_read_irq(w5500_ctrl_t *w5500)
  998. {
  999. OS_EVENT socket_event;
  1000. uint8_t temp[64];
  1001. uint8_t socket_irqs[MAX_SOCK_NUM];
  1002. uint8_t socket_irq, common_irq;
  1003. Buffer_Struct tx_msg_buf = {0,0,0};
  1004. uint32_t remote_ip;
  1005. int i, j;
  1006. w5500_xfer(w5500, W5500_COMMON_IR, 0, temp, W5500_COMMON_QTY - W5500_COMMON_IR);
  1007. common_irq = temp[0] & 0xf0;
  1008. socket_irq = temp[W5500_COMMON_SOCKET_IR - W5500_COMMON_IR];
  1009. w5500->device_on = (0x04 == temp[W5500_COMMON_VERSIONR - W5500_COMMON_IR])?1:0;
  1010. w5500_link_state(w5500, w5500->device_on?(temp[W5500_COMMON_PHY - W5500_COMMON_IR] & 0x01):0);
  1011. memset(socket_irqs, 0, MAX_SOCK_NUM);
  1012. if (!w5500->device_on)
  1013. {
  1014. luat_gpio_close(w5500->link_pin);
  1015. luat_gpio_close(w5500->irq_pin);
  1016. return;
  1017. }
  1018. if (common_irq)
  1019. {
  1020. if (common_irq & IR_CONFLICT)
  1021. {
  1022. memset(temp, 0, 4);
  1023. w5500_xfer(w5500, W5500_COMMON_IP0, is_write, temp, 4);
  1024. w5500->dhcp_client.state = DHCP_STATE_DECLINE;
  1025. ip4_dhcp_run(&w5500->dhcp_client, NULL, &tx_msg_buf, &remote_ip);
  1026. if (tx_msg_buf.Pos)
  1027. {
  1028. w5500_socket_connect(w5500, SYS_SOCK_ID, 0, remote_ip, DHCP_SERVER_PORT);
  1029. w5500_socket_tx(w5500, SYS_SOCK_ID, tx_msg_buf.Data, tx_msg_buf.Pos);
  1030. w5500->last_udp_send_ok = 0;
  1031. }
  1032. OS_DeInitBuffer(&tx_msg_buf);
  1033. w5500_ip_state(w5500, 0);
  1034. }
  1035. }
  1036. if (socket_irq)
  1037. {
  1038. for(i = 0; i < MAX_SOCK_NUM; i++)
  1039. {
  1040. if (socket_irq & (1 << i))
  1041. {
  1042. w5500_xfer(w5500, W5500_SOCKET_IR, socket_index(i)|socket_reg, &socket_irqs[i], 1);
  1043. temp[0] = socket_irqs[i];
  1044. w5500_xfer(w5500, W5500_SOCKET_IR, socket_index(i)|socket_reg|is_write, temp, 1);
  1045. }
  1046. }
  1047. }
  1048. temp[0] = 0;
  1049. temp[W5500_COMMON_IMR - W5500_COMMON_IR] = IR_CONFLICT|IR_UNREACH|IR_MAGIC;
  1050. temp[W5500_COMMON_SOCKET_IR - W5500_COMMON_IR] = 0;
  1051. w5500_xfer(w5500, W5500_COMMON_IR, is_write, temp, 1);
  1052. if (socket_irq)
  1053. {
  1054. for(i = 0; i < MAX_SOCK_NUM; i++)
  1055. {
  1056. if (socket_irqs[i])
  1057. {
  1058. for (j = 4; j >= 0; j--)
  1059. {
  1060. if (socket_irqs[i] & (1 << j))
  1061. {
  1062. w5500_sys_socket_callback(w5500, i, (1 << j));
  1063. }
  1064. }
  1065. }
  1066. }
  1067. }
  1068. }
  1069. static void w5500_task(void *param)
  1070. {
  1071. w5500_ctrl_t *w5500 = (w5500_ctrl_t *)param;
  1072. OS_EVENT event;
  1073. int result;
  1074. Buffer_Struct tx_msg_buf = {0,0,0};
  1075. uint32_t remote_ip, sleep_time;
  1076. PV_Union uPV;
  1077. socket_data_t *p;
  1078. w5500_init_reg(w5500);
  1079. while(1)
  1080. {
  1081. if (w5500->inter_error >= 2)
  1082. {
  1083. DBG("w5500 error too much, reboot");
  1084. w5500_init_reg(w5500);
  1085. }
  1086. sleep_time = 100;
  1087. if (w5500->network_ready)
  1088. {
  1089. if (!w5500->dns_client.is_run && (w5500->link_pin != 0xff))
  1090. {
  1091. sleep_time = 0;
  1092. }
  1093. else
  1094. {
  1095. sleep_time = 1000;
  1096. }
  1097. }
  1098. else if (w5500->link_ready)
  1099. {
  1100. sleep_time = 500;
  1101. }
  1102. else if (w5500->link_pin != 0xff)
  1103. {
  1104. sleep_time = 0;
  1105. }
  1106. result = platform_wait_event(w5500->task_handle, 0, &event, NULL, sleep_time);
  1107. w5500_xfer(w5500, W5500_COMMON_MR, 0, NULL, W5500_COMMON_QTY);
  1108. w5500->device_on = (0x04 == w5500->rx_buf[3 + W5500_COMMON_VERSIONR])?1:0;
  1109. if (w5500->device_on && w5500->rx_buf[3 + W5500_COMMON_IMR] != (IR_CONFLICT|IR_UNREACH|IR_MAGIC))
  1110. {
  1111. w5500_init_reg(w5500);
  1112. }
  1113. if (!w5500->device_on)
  1114. {
  1115. w5500_link_state(w5500, 0);
  1116. luat_gpio_close(w5500->link_pin);
  1117. luat_gpio_close(w5500->irq_pin);
  1118. }
  1119. else
  1120. {
  1121. w5500_link_state(w5500, w5500->rx_buf[3 + W5500_COMMON_PHY] & 0x01);
  1122. w5500->speed_status = w5500->rx_buf[3 + W5500_COMMON_PHY] & (3 << 1);
  1123. }
  1124. if (result)
  1125. {
  1126. if (w5500->network_ready)
  1127. {
  1128. w5500_dns_tx_next(w5500, &tx_msg_buf);
  1129. }
  1130. else if (w5500->link_ready)
  1131. {
  1132. result = ip4_dhcp_run(&w5500->dhcp_client, NULL, &tx_msg_buf, &remote_ip);
  1133. w5500_check_dhcp(w5500);
  1134. if (tx_msg_buf.Pos)
  1135. {
  1136. w5500_socket_connect(w5500, SYS_SOCK_ID, 0, remote_ip, DHCP_SERVER_PORT);
  1137. w5500_socket_tx(w5500, SYS_SOCK_ID, tx_msg_buf.Data, tx_msg_buf.Pos);
  1138. w5500->last_udp_send_ok = 0;
  1139. }
  1140. OS_DeInitBuffer(&tx_msg_buf);
  1141. }
  1142. continue;
  1143. }
  1144. switch(event.ID)
  1145. {
  1146. case EV_W5500_IRQ:
  1147. if (w5500->device_on)
  1148. {
  1149. w5500_read_irq(w5500);
  1150. }
  1151. break;
  1152. case EV_W5500_SOCKET_TX:
  1153. if (event.Param1) W5500_LOCK;
  1154. p = llist_traversal(&w5500->socket[event.Param1].tx_head, w5500_next_data_cache, &prv_w5500_ctrl->socket[event.Param1]);
  1155. if (event.Param1) W5500_UNLOCK;
  1156. if (p && p->is_sending)
  1157. {
  1158. // DBG("socket %d is sending, need wait!", event.Param1);
  1159. }
  1160. else
  1161. {
  1162. w5500_socket_tx_next_data(w5500, event.Param1);
  1163. if (!p->is_sending)
  1164. {
  1165. w5500_callback_to_nw_task(w5500, EV_NW_SOCKET_ERROR, event.Param1, 0, 0);
  1166. }
  1167. }
  1168. break;
  1169. case EV_W5500_SOCKET_CONNECT:
  1170. uPV.u8[0] = 0;
  1171. while(w5500_socket_state(w5500, event.Param1) != SOCK_CLOSED)
  1172. {
  1173. w5500_socket_close(w5500, event.Param1);
  1174. uPV.u8[0]++;
  1175. if (uPV.u8[0] > 100)
  1176. {
  1177. w5500_callback_to_nw_task(w5500, EV_NW_SOCKET_ERROR, event.Param1, 0, 0);
  1178. break;
  1179. }
  1180. }
  1181. uPV.u32 = event.Param3;
  1182. w5500_socket_config(w5500, event.Param1, w5500->socket[event.Param1].is_tcp, uPV.u16[0]);
  1183. w5500_socket_connect(w5500, event.Param1, 0, event.Param2, uPV.u16[1]);
  1184. if (!w5500->socket[event.Param1].is_tcp)
  1185. {
  1186. w5500_callback_to_nw_task(w5500, EV_NW_SOCKET_CONNECT_OK, event.Param1, 0, 0);
  1187. }
  1188. break;
  1189. case EV_W5500_SOCKET_CLOSE:
  1190. if ((w5500_socket_state(w5500, event.Param1) != SOCK_CLOSED))
  1191. {
  1192. w5500_socket_disconnect(w5500, event.Param1);
  1193. }
  1194. else
  1195. {
  1196. w5500_callback_to_nw_task(w5500, EV_NW_SOCKET_CLOSE_OK, event.Param1, 0, 0);
  1197. }
  1198. break;
  1199. case EV_W5500_SOCKET_LISTEN:
  1200. uPV.u8[0] = 0;
  1201. while(w5500_socket_state(w5500, event.Param1) != SOCK_CLOSED)
  1202. {
  1203. w5500_socket_close(w5500, event.Param1);
  1204. uPV.u8[0]++;
  1205. if (uPV.u8[0] > 100)
  1206. {
  1207. w5500_callback_to_nw_task(w5500, EV_NW_SOCKET_ERROR, event.Param1, 0, 0);
  1208. }
  1209. }
  1210. uPV.u32 = event.Param3;
  1211. w5500_socket_config(w5500, event.Param1, w5500->socket[event.Param1].is_tcp, event.Param2);
  1212. w5500_socket_connect(w5500, event.Param1, 1, 0xffffffff, 0xff00);
  1213. w5500_callback_to_nw_task(w5500, EV_NW_SOCKET_LISTEN, event.Param1, 0, 0);
  1214. break;
  1215. case EV_W5500_SOCKET_DNS:
  1216. if (w5500->network_ready)
  1217. {
  1218. dns_require(&w5500->dns_client, event.Param1, event.Param2, event.Param3);
  1219. w5500_dns_tx_next(w5500, &tx_msg_buf);
  1220. }
  1221. break;
  1222. case EV_W5500_RE_INIT:
  1223. w5500_init_reg(w5500);
  1224. break;
  1225. case EV_W5500_REG_OP:
  1226. uPV.u8[0] = event.Param3;
  1227. w5500_xfer(w5500, event.Param1, socket_index(event.Param2)|socket_reg|is_write, uPV.u8, 1);
  1228. break;
  1229. case EV_W5500_LINK:
  1230. w5500_link_state(w5500, !luat_gpio_get(w5500->link_pin));
  1231. break;
  1232. }
  1233. }
  1234. }
  1235. int w5500_set_static_ip(uint32_t ipv4, uint32_t submask, uint32_t gateway)
  1236. {
  1237. if (prv_w5500_ctrl)
  1238. {
  1239. prv_w5500_ctrl->static_ip = ipv4;
  1240. prv_w5500_ctrl->static_submask = submask;
  1241. prv_w5500_ctrl->static_gateway = gateway;
  1242. }
  1243. }
  1244. void w5500_set_mac(uint8_t mac[6])
  1245. {
  1246. if (prv_w5500_ctrl)
  1247. {
  1248. memcpy(prv_w5500_ctrl->mac, mac, 6);
  1249. }
  1250. }
  1251. void w5500_set_param(uint16_t timeout, uint8_t retry, uint8_t auto_speed, uint8_t force_arp)
  1252. {
  1253. if (prv_w5500_ctrl)
  1254. {
  1255. prv_w5500_ctrl->RTR = timeout;
  1256. prv_w5500_ctrl->RTR = retry;
  1257. prv_w5500_ctrl->auto_speed = auto_speed;
  1258. prv_w5500_ctrl->force_arp = force_arp;
  1259. }
  1260. }
  1261. int w5500_reset(void)
  1262. {
  1263. if (prv_w5500_ctrl && prv_w5500_ctrl->device_on)
  1264. {
  1265. platform_send_event(prv_w5500_ctrl->task_handle, EV_W5500_RE_INIT, 0, 0, 0);
  1266. return 0;
  1267. }
  1268. else
  1269. {
  1270. return -1;
  1271. }
  1272. }
  1273. void w5500_init(luat_spi_t* spi, uint8_t irq_pin, uint8_t rst_pin, uint8_t link_pin)
  1274. {
  1275. uint8_t *uid;
  1276. size_t t, i;
  1277. if (!prv_w5500_ctrl)
  1278. {
  1279. w5500_ctrl_t *w5500 = malloc(sizeof(w5500_ctrl_t));
  1280. memset(w5500, 0, sizeof(w5500_ctrl_t));
  1281. w5500->socket_cb = w5500_dummy_callback;
  1282. w5500->tag = GetSysTickMS();
  1283. w5500->RCR = 8;
  1284. w5500->RTR = 2000;
  1285. w5500->spi_id = spi->id;
  1286. w5500->cs_pin = spi->cs;
  1287. w5500->irq_pin = irq_pin;
  1288. w5500->rst_pin = rst_pin;
  1289. w5500->link_pin = link_pin;
  1290. spi->cs = 0xff;
  1291. luat_spi_setup(spi);
  1292. luat_spi_config_dma(w5500->spi_id, 0xffff, 0xffff);
  1293. luat_gpio_t gpio = {0};
  1294. gpio.pin = w5500->cs_pin;
  1295. gpio.mode = Luat_GPIO_OUTPUT;
  1296. gpio.pull = Luat_GPIO_DEFAULT;
  1297. luat_gpio_setup(&gpio);
  1298. luat_gpio_set(w5500->cs_pin, 1);
  1299. gpio.pin = w5500->rst_pin;
  1300. luat_gpio_setup(&gpio);
  1301. luat_gpio_set(w5500->rst_pin, 0);
  1302. char rands[4];
  1303. platform_random(rands, 4);
  1304. for(i = 0; i < MAX_SOCK_NUM; i++)
  1305. {
  1306. INIT_LLIST_HEAD(&w5500->socket[i].tx_head);
  1307. INIT_LLIST_HEAD(&w5500->socket[i].rx_head);
  1308. }
  1309. INIT_LLIST_HEAD(&w5500->dns_client.process_head);
  1310. INIT_LLIST_HEAD(&w5500->dns_client.require_head);
  1311. w5500->dhcp_client.xid = BytesGetBe32(rands);
  1312. w5500->dhcp_client.state = DHCP_STATE_NOT_WORK;
  1313. uid = luat_mcu_unique_id(&t);
  1314. memcpy(w5500->mac, &uid[10], 6);
  1315. luat_thread_t thread;
  1316. thread.task_fun = w5500_task;
  1317. thread.name = "w5500";
  1318. thread.stack_size = 4 * 1024;
  1319. thread.priority = 3;
  1320. thread.userdata = w5500;
  1321. platform_create_task(&thread);
  1322. prv_w5500_ctrl = w5500;
  1323. w5500->task_handle = thread.handle;
  1324. prv_w5500_ctrl->device_on = 1;
  1325. }
  1326. }
  1327. uint8_t w5500_device_ready(void)
  1328. {
  1329. if (prv_w5500_ctrl)
  1330. {
  1331. return prv_w5500_ctrl->device_on;
  1332. }
  1333. else
  1334. {
  1335. return 0;
  1336. }
  1337. }
  1338. static int w5500_check_socket(w5500_ctrl_t *w5500, int socket_id, uint64_t tag)
  1339. {
  1340. if (w5500 != prv_w5500_ctrl) return -1;
  1341. if (socket_id < 1 || socket_id >= MAX_SOCK_NUM) return -1;
  1342. if (w5500->socket[socket_id].tag != tag) return -1;
  1343. if (!w5500->socket[socket_id].in_use) return -1;
  1344. return 0;
  1345. }
  1346. static int w5500_socket_check(int socket_id, uint64_t tag, void *user_data)
  1347. {
  1348. return w5500_check_socket(user_data, socket_id, tag);
  1349. }
  1350. static uint8_t w5500_check_ready(void *user_data)
  1351. {
  1352. return ((w5500_ctrl_t *)user_data)->network_ready;
  1353. }
  1354. static int w5500_create_soceket(uint8_t is_tcp, uint64_t *tag, void *param, uint8_t is_ipv6, void *user_data)
  1355. {
  1356. if (user_data != prv_w5500_ctrl) return -1;
  1357. int i, socket_id;
  1358. socket_id = -1;
  1359. W5500_LOCK;
  1360. if (!prv_w5500_ctrl->socket[prv_w5500_ctrl->next_socket_index].in_use)
  1361. {
  1362. socket_id = prv_w5500_ctrl->next_socket_index;
  1363. prv_w5500_ctrl->next_socket_index++;
  1364. }
  1365. else
  1366. {
  1367. for (i = 1; i < MAX_SOCK_NUM; i++)
  1368. {
  1369. if (!prv_w5500_ctrl->socket[i].in_use)
  1370. {
  1371. socket_id = i;
  1372. prv_w5500_ctrl->next_socket_index = i + 1;
  1373. break;
  1374. }
  1375. }
  1376. }
  1377. if (prv_w5500_ctrl->next_socket_index >= MAX_SOCK_NUM)
  1378. {
  1379. prv_w5500_ctrl->next_socket_index = 1;
  1380. }
  1381. if (socket_id > 0)
  1382. {
  1383. prv_w5500_ctrl->tag++;
  1384. *tag = prv_w5500_ctrl->tag;
  1385. prv_w5500_ctrl->socket[socket_id].in_use = 1;
  1386. prv_w5500_ctrl->socket[socket_id].tag = *tag;
  1387. prv_w5500_ctrl->socket[socket_id].rx_wait_size = 0;
  1388. prv_w5500_ctrl->socket[socket_id].tx_wait_size = 0;
  1389. prv_w5500_ctrl->socket[socket_id].param = param;
  1390. prv_w5500_ctrl->socket[socket_id].is_tcp = is_tcp;
  1391. prv_w5500_ctrl->socket[socket_id].rx_waiting = 0;
  1392. llist_traversal(&prv_w5500_ctrl->socket[socket_id].tx_head, w5500_del_data_cache, NULL);
  1393. llist_traversal(&prv_w5500_ctrl->socket[socket_id].rx_head, w5500_del_data_cache, NULL);
  1394. }
  1395. W5500_UNLOCK;
  1396. return socket_id;
  1397. }
  1398. //作为client绑定一个port,并连接remote_ip和remote_port对应的server
  1399. static int w5500_socket_connect_ex(int socket_id, uint64_t tag, uint16_t local_port, luat_ip_addr_t *remote_ip, uint16_t remote_port, void *user_data)
  1400. {
  1401. int result = w5500_check_socket(user_data, socket_id, tag);
  1402. if (result) return result;
  1403. PV_Union uPV;
  1404. uPV.u16[0] = local_port;
  1405. uPV.u16[1] = remote_port;
  1406. W5500_LOCK;
  1407. llist_traversal(&prv_w5500_ctrl->socket[socket_id].tx_head, w5500_del_data_cache, NULL);
  1408. llist_traversal(&prv_w5500_ctrl->socket[socket_id].rx_head, w5500_del_data_cache, NULL);
  1409. W5500_UNLOCK;
  1410. platform_send_event(prv_w5500_ctrl->task_handle, EV_W5500_SOCKET_CONNECT, socket_id, remote_ip->ipv4, uPV.u32);
  1411. uPV.u32 = remote_ip->ipv4;
  1412. // DBG("%u.%u.%u.%u", uPV.u8[0], uPV.u8[1], uPV.u8[2], uPV.u8[3]);
  1413. return 0;
  1414. }
  1415. //作为server绑定一个port,开始监听
  1416. static int w5500_socket_listen(int socket_id, uint64_t tag, uint16_t local_port, void *user_data)
  1417. {
  1418. int result = w5500_check_socket(user_data, socket_id, tag);
  1419. if (result) return result;
  1420. platform_send_event(prv_w5500_ctrl->task_handle, EV_W5500_SOCKET_LISTEN, socket_id, local_port, NULL);
  1421. return 0;
  1422. }
  1423. //作为server接受一个client
  1424. static int w5500_socket_accept(int socket_id, uint64_t tag, luat_ip_addr_t *remote_ip, uint16_t *remote_port, void *user_data)
  1425. {
  1426. uint8_t temp[16];
  1427. int result = w5500_check_socket(user_data, socket_id, tag);
  1428. if (result) return result;
  1429. w5500_xfer(user_data, W5500_SOCKET_DEST_IP0, socket_index(socket_id)|socket_reg, temp, 6);
  1430. remote_ip->is_ipv6 = 0;
  1431. remote_ip->ipv4 = BytesGetLe32(temp);
  1432. *remote_port = BytesGetBe16(temp + 4);
  1433. DBG("client %d.%d.%d.%d, %u", temp[0], temp[1], temp[2], temp[3], *remote_port);
  1434. return 0;
  1435. }
  1436. //主动断开一个tcp连接,需要走完整个tcp流程,用户需要接收到close ok回调才能确认彻底断开
  1437. static int w5500_socket_disconnect_ex(int socket_id, uint64_t tag, void *user_data)
  1438. {
  1439. int result = w5500_check_socket(user_data, socket_id, tag);
  1440. if (result) return result;
  1441. platform_send_event(prv_w5500_ctrl->task_handle, EV_W5500_SOCKET_CLOSE, socket_id, 0, 0);
  1442. return 0;
  1443. }
  1444. static int w5500_socket_force_close(int socket_id, void *user_data)
  1445. {
  1446. W5500_LOCK;
  1447. w5500_socket_close(prv_w5500_ctrl, socket_id);
  1448. if (prv_w5500_ctrl->socket[socket_id].in_use)
  1449. {
  1450. prv_w5500_ctrl->socket[socket_id].in_use = 0;
  1451. prv_w5500_ctrl->socket[socket_id].tag = 0;
  1452. llist_traversal(&prv_w5500_ctrl->socket[socket_id].tx_head, w5500_del_data_cache, NULL);
  1453. llist_traversal(&prv_w5500_ctrl->socket[socket_id].rx_head, w5500_del_data_cache, NULL);
  1454. prv_w5500_ctrl->socket[socket_id].rx_wait_size = 0;
  1455. prv_w5500_ctrl->socket[socket_id].tx_wait_size = 0;
  1456. prv_w5500_ctrl->socket[socket_id].param = NULL;
  1457. }
  1458. W5500_UNLOCK;
  1459. return 0;
  1460. }
  1461. static int w5500_socket_close_ex(int socket_id, uint64_t tag, void *user_data)
  1462. {
  1463. int result = w5500_check_socket(user_data, socket_id, tag);
  1464. if (result) return result;
  1465. return w5500_socket_force_close(socket_id, user_data);
  1466. }
  1467. static uint32_t w5500_socket_read_data(uint8_t *buf, uint32_t *read_len, uint32_t len, socket_data_t *p)
  1468. {
  1469. uint32_t dummy_len;
  1470. dummy_len = ((p->len - p->read_pos) > (len - *read_len))?(len - *read_len):(p->len - p->read_pos);
  1471. memcpy(buf, p->data + p->read_pos, dummy_len);
  1472. p->read_pos += dummy_len;
  1473. if (p->read_pos >= p->len)
  1474. {
  1475. llist_del(&p->node);
  1476. free(p->data);
  1477. free(p);
  1478. }
  1479. *read_len += dummy_len;
  1480. return dummy_len;
  1481. }
  1482. static int w5500_socket_receive(int socket_id, uint64_t tag, uint8_t *buf, uint32_t len, int flags, luat_ip_addr_t *remote_ip, uint16_t *remote_port, void *user_data)
  1483. {
  1484. int result = w5500_check_socket(user_data, socket_id, tag);
  1485. if (result) return result;
  1486. W5500_LOCK;
  1487. uint32_t read_len = 0;
  1488. if (buf)
  1489. {
  1490. socket_data_t *p = (socket_data_t *)llist_traversal(&prv_w5500_ctrl->socket[socket_id].rx_head, w5500_next_data_cache, &prv_w5500_ctrl->socket[socket_id]);
  1491. if (prv_w5500_ctrl->socket[socket_id].is_tcp)
  1492. {
  1493. while((read_len < len) && p)
  1494. {
  1495. prv_w5500_ctrl->socket[socket_id].rx_wait_size -= w5500_socket_read_data(buf + read_len, &read_len, len, p);
  1496. p = (socket_data_t *)llist_traversal(&prv_w5500_ctrl->socket[socket_id].rx_head, w5500_next_data_cache, &prv_w5500_ctrl->socket[socket_id]);
  1497. }
  1498. }
  1499. else
  1500. {
  1501. prv_w5500_ctrl->socket[socket_id].rx_wait_size -= w5500_socket_read_data(buf + read_len, &read_len, len, p);
  1502. }
  1503. if (llist_empty(&prv_w5500_ctrl->socket[socket_id].rx_head))
  1504. {
  1505. prv_w5500_ctrl->socket[socket_id].rx_wait_size = 0;
  1506. }
  1507. }
  1508. else
  1509. {
  1510. read_len = prv_w5500_ctrl->socket[socket_id].rx_wait_size;
  1511. }
  1512. W5500_UNLOCK;
  1513. if ((prv_w5500_ctrl->socket[socket_id].rx_wait_size < SOCK_BUF_LEN) && prv_w5500_ctrl->socket[socket_id].rx_waiting)
  1514. {
  1515. prv_w5500_ctrl->socket[socket_id].rx_waiting = 0;
  1516. DBG("read waiting data");
  1517. w5500_sys_socket_callback(prv_w5500_ctrl, socket_id, Sn_IR_RECV);
  1518. }
  1519. return read_len;
  1520. }
  1521. static int w5500_socket_send(int socket_id, uint64_t tag, const uint8_t *buf, uint32_t len, int flags, luat_ip_addr_t *remote_ip, uint16_t remote_port, void *user_data)
  1522. {
  1523. int result = w5500_check_socket(user_data, socket_id, tag);
  1524. if (result) return result;
  1525. if (prv_w5500_ctrl->socket[socket_id].tx_wait_size >= SOCK_BUF_LEN) return 0;
  1526. socket_data_t *p = w5500_create_data_node(prv_w5500_ctrl, socket_id, buf, len, remote_ip, remote_port);
  1527. if (p)
  1528. {
  1529. W5500_LOCK;
  1530. llist_add_tail(&p->node, &prv_w5500_ctrl->socket[socket_id].tx_head);
  1531. prv_w5500_ctrl->socket[socket_id].tx_wait_size += len;
  1532. W5500_UNLOCK;
  1533. platform_send_event(prv_w5500_ctrl->task_handle, EV_W5500_SOCKET_TX, socket_id, 0, 0);
  1534. result = len;
  1535. }
  1536. else
  1537. {
  1538. result = -1;
  1539. }
  1540. return result;
  1541. }
  1542. void w5500_socket_clean(int *vaild_socket_list, uint32_t num, void *user_data)
  1543. {
  1544. if (user_data != prv_w5500_ctrl) return;
  1545. int socket_list[MAX_SOCK_NUM] = {0,0,0,0,0,0,0,0};
  1546. uint32_t i;
  1547. for(i = 1; i < num + 1; i++)
  1548. {
  1549. if ( (vaild_socket_list[i] > 0) && (vaild_socket_list[i] < MAX_SOCK_NUM) )
  1550. {
  1551. socket_list[vaild_socket_list[i]] = 1;
  1552. }
  1553. DBG("%d,%d",i,vaild_socket_list[i]);
  1554. }
  1555. for(i = 1; i < MAX_SOCK_NUM; i++)
  1556. {
  1557. DBG("%d,%d",i,socket_list[i]);
  1558. if ( !socket_list[i] )
  1559. {
  1560. W5500_LOCK;
  1561. prv_w5500_ctrl->socket[i].in_use = 0;
  1562. prv_w5500_ctrl->socket[i].tag = 0;
  1563. llist_traversal(&prv_w5500_ctrl->socket[i].tx_head, w5500_del_data_cache, NULL);
  1564. llist_traversal(&prv_w5500_ctrl->socket[i].rx_head, w5500_del_data_cache, NULL);
  1565. prv_w5500_ctrl->socket[i].rx_wait_size = 0;
  1566. prv_w5500_ctrl->socket[i].tx_wait_size = 0;
  1567. w5500_socket_close(prv_w5500_ctrl, i);
  1568. W5500_UNLOCK;
  1569. }
  1570. }
  1571. }
  1572. static int w5500_getsockopt(int socket_id, uint64_t tag, int level, int optname, void *optval, uint32_t *optlen, void *user_data)
  1573. {
  1574. return -1;
  1575. }
  1576. static int w5500_setsockopt(int socket_id, uint64_t tag, int level, int optname, const void *optval, uint32_t optlen, void *user_data)
  1577. {
  1578. return -1;
  1579. }
  1580. static int w5500_get_local_ip_info(luat_ip_addr_t *ip, luat_ip_addr_t *submask, luat_ip_addr_t *gateway, void *user_data)
  1581. {
  1582. if (user_data != prv_w5500_ctrl) return -1;
  1583. if (prv_w5500_ctrl->static_ip)
  1584. {
  1585. ip->ipv4 = prv_w5500_ctrl->static_ip;
  1586. ip->is_ipv6 = 0;
  1587. submask->ipv4 = prv_w5500_ctrl->static_submask;
  1588. submask->is_ipv6 = 0;
  1589. gateway->ipv4 = prv_w5500_ctrl->static_gateway;
  1590. gateway->is_ipv6 = 0;
  1591. return 0;
  1592. }
  1593. else
  1594. {
  1595. if (!prv_w5500_ctrl->ip_ready)
  1596. {
  1597. return -1;
  1598. }
  1599. ip->ipv4 = prv_w5500_ctrl->dhcp_client.ip;
  1600. ip->is_ipv6 = 0;
  1601. submask->ipv4 = prv_w5500_ctrl->dhcp_client.submask;
  1602. submask->is_ipv6 = 0;
  1603. gateway->ipv4 = prv_w5500_ctrl->dhcp_client.gateway;
  1604. gateway->is_ipv6 = 0;
  1605. return 0;
  1606. }
  1607. }
  1608. static int w5500_user_cmd(int socket_id, uint64_t tag, uint32_t cmd, uint32_t value, void *user_data)
  1609. {
  1610. int result = w5500_check_socket(user_data, socket_id, tag);
  1611. if (result) return result;
  1612. switch (cmd)
  1613. {
  1614. case NW_CMD_AUTO_HEART_TIME:
  1615. value = (value + 4) / 5;
  1616. platform_send_event(prv_w5500_ctrl->task_handle, EV_W5500_REG_OP, W5500_SOCKET_KEEP_TIME, socket_id, value);
  1617. break;
  1618. default:
  1619. return -1;
  1620. }
  1621. return 0;
  1622. }
  1623. static int w5500_dns(const char *domain_name, uint32_t len, void *param, void *user_data)
  1624. {
  1625. if (user_data != prv_w5500_ctrl) return -1;
  1626. char *prv_domain_name = (char *)malloc(len);
  1627. memcpy(prv_domain_name, domain_name, len);
  1628. platform_send_event(prv_w5500_ctrl->task_handle, EV_W5500_SOCKET_DNS, prv_domain_name, len, param);
  1629. return 0;
  1630. }
  1631. static int w5500_set_dns_server(uint8_t server_index, luat_ip_addr_t *ip, void *user_data)
  1632. {
  1633. if (user_data != prv_w5500_ctrl) return -1;
  1634. if (server_index >= MAX_DNS_SERVER) return -1;
  1635. prv_w5500_ctrl->dns_client.dns_server[server_index] = *ip;
  1636. prv_w5500_ctrl->dns_client.is_static_dns[server_index] = 1;
  1637. return 0;
  1638. }
  1639. static void w5500_socket_set_callback(CBFuncEx_t cb_fun, void *param, void *user_data)
  1640. {
  1641. if (user_data != prv_w5500_ctrl) return ;
  1642. ((w5500_ctrl_t *)user_data)->socket_cb = cb_fun?cb_fun:w5500_dummy_callback;
  1643. ((w5500_ctrl_t *)user_data)->user_data = param;
  1644. }
  1645. static network_adapter_info prv_w5500_adapter =
  1646. {
  1647. .check_ready = w5500_check_ready,
  1648. .create_soceket = w5500_create_soceket,
  1649. .socket_connect = w5500_socket_connect_ex,
  1650. .socket_listen = w5500_socket_listen,
  1651. .socket_accept = w5500_socket_accept,
  1652. .socket_disconnect = w5500_socket_disconnect_ex,
  1653. .socket_close = w5500_socket_close_ex,
  1654. .socket_force_close = w5500_socket_force_close,
  1655. .socket_receive = w5500_socket_receive,
  1656. .socket_send = w5500_socket_send,
  1657. .socket_check = w5500_socket_check,
  1658. .socket_clean = w5500_socket_clean,
  1659. .getsockopt = w5500_getsockopt,
  1660. .setsockopt = w5500_setsockopt,
  1661. .user_cmd = w5500_user_cmd,
  1662. .dns = w5500_dns,
  1663. .set_dns_server = w5500_set_dns_server,
  1664. .get_local_ip_info = w5500_get_local_ip_info,
  1665. .socket_set_callback = w5500_socket_set_callback,
  1666. .name = "w5500",
  1667. .max_socket_num = MAX_SOCK_NUM - 1,
  1668. .no_accept = 1,
  1669. .is_posix = 0,
  1670. };
  1671. void w5500_register_adapter(int index)
  1672. {
  1673. if (prv_w5500_ctrl)
  1674. {
  1675. network_register_adapter(index, &prv_w5500_adapter, prv_w5500_ctrl);
  1676. }
  1677. }
  1678. #else
  1679. void w5500_init(luat_spi_t* spi, uint8_t irq_pin, uint8_t rst_pin) {;}
  1680. void w5500_set_static_ip(uint32_t ipv4, uint32_t submask, uint32_t gateway) {;}
  1681. void w5500_set_mac(uint8_t mac[6]) {;}
  1682. void w5500_set_param(uint16_t timeout, uint8_t retry, uint8_t auto_speed, uint8_t force_arp) {;}
  1683. int w5500_reset(void) {return -1;}
  1684. uint32_t w5500_string_to_ip(const char *string, uint32_t len) {return 0;}
  1685. void w5500_array_to_mac(uint8_t *array, uint32_t *mac1, uint16_t *mac2) {return;}
  1686. uint8_t w5500_device_ready(void) {return 0;}
  1687. void w5500_register_adapter(int index) {;}
  1688. #endif