33569633c308ad56f110e4a8568e9830d1188883
[platform/upstream/libwebsockets.git] / lib / lws-plat-esp32.c
1 /*
2  * libwebsockets - small server side websockets and web server implementation
3  *
4  * Copyright (C) 2010-2017 Andy Green <andy@warmcat.com>
5  *
6  *  This library is free software; you can redistribute it and/or
7  *  modify it under the terms of the GNU Lesser General Public
8  *  License as published by the Free Software Foundation:
9  *  version 2.1 of the License.
10  *
11  *  This library is distributed in the hope that it will be useful,
12  *  but WITHOUT ANY WARRANTY; without even the implied warranty of
13  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
14  *  Lesser General Public License for more details.
15  *
16  *  You should have received a copy of the GNU Lesser General Public
17  *  License along with this library; if not, write to the Free Software
18  *  Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston,
19  *  MA  02110-1301  USA
20  */
21
22 #include "private-libwebsockets.h"
23 #include "freertos/timers.h"
24 #include <esp_attr.h>
25 #include <esp_system.h>
26
27 /*
28  * included from libwebsockets.c for unix builds
29  */
30
31 unsigned long long time_in_microseconds(void)
32 {
33         struct timeval tv;
34         gettimeofday(&tv, NULL);
35         return ((unsigned long long)tv.tv_sec * 1000000LL) + tv.tv_usec;
36 }
37
38 LWS_VISIBLE int
39 lws_get_random(struct lws_context *context, void *buf, int len)
40 {
41         uint8_t *pb = buf;
42
43         while (len) {
44                 uint32_t r = esp_random();
45                 uint8_t *p = (uint8_t *)&r;
46                 int b = 4;
47
48                 if (len < b)
49                         b = len;
50
51                 len -= b;
52
53                 while (b--)
54                         *pb++ = p[b];
55         }
56
57         return pb - (uint8_t *)buf;
58 }
59
60 LWS_VISIBLE int
61 lws_send_pipe_choked(struct lws *wsi)
62 {
63         fd_set writefds;
64         struct timeval tv = { 0, 0 };
65
66         /* treat the fact we got a truncated send pending as if we're choked */
67         if (wsi->trunc_len)
68                 return 1;
69
70         FD_ZERO(&writefds);
71         FD_SET(wsi->desc.sockfd, &writefds);
72
73         if (select(wsi->desc.sockfd + 1, NULL, &writefds, NULL, &tv) < 1)
74                 return 1;
75
76         return 0;
77 }
78
79 LWS_VISIBLE int
80 lws_poll_listen_fd(struct lws_pollfd *fd)
81 {
82         fd_set readfds;
83         struct timeval tv = { 0, 0 };
84
85         FD_ZERO(&readfds);
86         FD_SET(fd->fd, &readfds);
87
88         return select(fd->fd + 1, &readfds, NULL, NULL, &tv);
89 }
90
91 LWS_VISIBLE void
92 lws_cancel_service_pt(struct lws *wsi)
93 {
94 }
95
96 LWS_VISIBLE void
97 lws_cancel_service(struct lws_context *context)
98 {
99 }
100
101 LWS_VISIBLE void lwsl_emit_syslog(int level, const char *line)
102 {
103         printf("%d: %s", level, line);
104 }
105
106 LWS_VISIBLE LWS_EXTERN int
107 _lws_plat_service_tsi(struct lws_context *context, int timeout_ms, int tsi)
108 {
109         struct lws_context_per_thread *pt;
110         int n = -1, m, c;
111
112         /* stay dead once we are dead */
113
114         if (!context || !context->vhost_list)
115                 return 1;
116
117         pt = &context->pt[tsi];
118         lws_stats_atomic_bump(context, pt, LWSSTATS_C_SERVICE_ENTRY, 1);
119
120         if (timeout_ms < 0)
121                 goto faked_service;
122
123         if (!context->service_tid_detected) {
124                 struct lws _lws;
125
126                 memset(&_lws, 0, sizeof(_lws));
127                 _lws.context = context;
128
129                 context->service_tid_detected =
130                         context->vhost_list->protocols[0].callback(
131                         &_lws, LWS_CALLBACK_GET_THREAD_ID, NULL, NULL, 0);
132         }
133         context->service_tid = context->service_tid_detected;
134
135         /*
136          * is there anybody with pending stuff that needs service forcing?
137          */
138         if (!lws_service_adjust_timeout(context, 1, tsi)) {
139                 /* -1 timeout means just do forced service */
140                 _lws_plat_service_tsi(context, -1, pt->tid);
141                 /* still somebody left who wants forced service? */
142                 if (!lws_service_adjust_timeout(context, 1, pt->tid))
143                         /* yes... come back again quickly */
144                         timeout_ms = 0;
145         }
146
147 //      n = poll(pt->fds, pt->fds_count, timeout_ms);
148         {
149                 fd_set readfds, writefds, errfds;
150                 struct timeval tv = { timeout_ms / 1000,
151                                       (timeout_ms % 1000) * 1000 }, *ptv = &tv;
152                 int max_fd = 0;
153                 FD_ZERO(&readfds);
154                 FD_ZERO(&writefds);
155                 FD_ZERO(&errfds);
156
157                 for (n = 0; n < pt->fds_count; n++) {
158                         pt->fds[n].revents = 0;
159                         if (pt->fds[n].fd >= max_fd)
160                                 max_fd = pt->fds[n].fd;
161                         if (pt->fds[n].events & LWS_POLLIN)
162                                 FD_SET(pt->fds[n].fd, &readfds);
163                         if (pt->fds[n].events & LWS_POLLOUT)
164                                 FD_SET(pt->fds[n].fd, &writefds);
165                         FD_SET(pt->fds[n].fd, &errfds);
166                 }
167
168                 n = select(max_fd + 1, &readfds, &writefds, &errfds, ptv);
169                 for (n = 0; n < pt->fds_count; n++) {
170                         if (FD_ISSET(pt->fds[n].fd, &readfds))
171                                 pt->fds[n].revents |= LWS_POLLIN;
172                         if (FD_ISSET(pt->fds[n].fd, &writefds))
173                                 pt->fds[n].revents |= LWS_POLLOUT;
174                         if (FD_ISSET(pt->fds[n].fd, &errfds))
175                                 pt->fds[n].revents |= LWS_POLLHUP;
176                 }
177         }
178
179
180 #ifdef LWS_OPENSSL_SUPPORT
181         if (!pt->rx_draining_ext_list &&
182             !lws_ssl_anybody_has_buffered_read_tsi(context, tsi) && !n) {
183 #else
184         if (!pt->rx_draining_ext_list && !n) /* poll timeout */ {
185 #endif
186                 lws_service_fd_tsi(context, NULL, tsi);
187                 return 0;
188         }
189
190 faked_service:
191         m = lws_service_flag_pending(context, tsi);
192         if (m)
193                 c = -1; /* unknown limit */
194         else
195                 if (n < 0) {
196                         if (LWS_ERRNO != LWS_EINTR)
197                                 return -1;
198                         return 0;
199                 } else
200                         c = n;
201
202         /* any socket with events to service? */
203         for (n = 0; n < pt->fds_count && c; n++) {
204                 if (!pt->fds[n].revents)
205                         continue;
206
207                 c--;
208
209                 m = lws_service_fd_tsi(context, &pt->fds[n], tsi);
210                 if (m < 0)
211                         return -1;
212                 /* if something closed, retry this slot */
213                 if (m)
214                         n--;
215         }
216
217         return 0;
218 }
219
220 LWS_VISIBLE int
221 lws_plat_check_connection_error(struct lws *wsi)
222 {
223         return 0;
224 }
225
226 LWS_VISIBLE int
227 lws_plat_service(struct lws_context *context, int timeout_ms)
228 {
229         return _lws_plat_service_tsi(context, timeout_ms, 0);
230 }
231
232 LWS_VISIBLE int
233 lws_plat_set_socket_options(struct lws_vhost *vhost, int fd)
234 {
235         int optval = 1;
236         socklen_t optlen = sizeof(optval);
237
238 #if defined(__APPLE__) || \
239     defined(__FreeBSD__) || defined(__FreeBSD_kernel__) || \
240     defined(__NetBSD__) || \
241     defined(__OpenBSD__)
242         struct protoent *tcp_proto;
243 #endif
244
245         if (vhost->ka_time) {
246                 /* enable keepalive on this socket */
247                 optval = 1;
248                 if (setsockopt(fd, SOL_SOCKET, SO_KEEPALIVE,
249                                (const void *)&optval, optlen) < 0)
250                         return 1;
251
252 #if defined(__APPLE__) || \
253     defined(__FreeBSD__) || defined(__FreeBSD_kernel__) || \
254     defined(__NetBSD__) || \
255         defined(__CYGWIN__) || defined(__OpenBSD__) || defined (__sun)
256
257                 /*
258                  * didn't find a way to set these per-socket, need to
259                  * tune kernel systemwide values
260                  */
261 #else
262                 /* set the keepalive conditions we want on it too */
263                 optval = vhost->ka_time;
264                 if (setsockopt(fd, IPPROTO_TCP, TCP_KEEPIDLE,
265                                (const void *)&optval, optlen) < 0)
266                         return 1;
267
268                 optval = vhost->ka_interval;
269                 if (setsockopt(fd, IPPROTO_TCP, TCP_KEEPINTVL,
270                                (const void *)&optval, optlen) < 0)
271                         return 1;
272
273                 optval = vhost->ka_probes;
274                 if (setsockopt(fd, IPPROTO_TCP, TCP_KEEPCNT,
275                                (const void *)&optval, optlen) < 0)
276                         return 1;
277 #endif
278         }
279
280         /* Disable Nagle */
281         optval = 1;
282 //      if (setsockopt(fd, SOL_TCP, TCP_NODELAY, (const void *)&optval, optlen) < 0)
283 //              return 1;
284         if (setsockopt(fd, IPPROTO_TCP, TCP_NODELAY, &optval, optlen) < 0)
285                 return 1;
286
287         /* We are nonblocking... */
288         if (fcntl(fd, F_SETFL, O_NONBLOCK) < 0)
289                 return 1;
290
291         return 0;
292 }
293
294 LWS_VISIBLE void
295 lws_plat_drop_app_privileges(struct lws_context_creation_info *info)
296 {
297 }
298
299 LWS_VISIBLE int
300 lws_plat_context_early_init(void)
301 {
302         //signal(SIGPIPE, SIG_IGN);
303
304 //      signal(SIGABRT, sigabrt_handler);
305
306         return 0;
307 }
308
309 LWS_VISIBLE void
310 lws_plat_context_early_destroy(struct lws_context *context)
311 {
312 }
313
314 LWS_VISIBLE void
315 lws_plat_context_late_destroy(struct lws_context *context)
316 {
317 #ifdef LWS_WITH_PLUGINS
318         if (context->plugin_list)
319                 lws_plat_plugins_destroy(context);
320 #endif
321
322         if (context->lws_lookup)
323                 lws_free(context->lws_lookup);
324 }
325
326 /* cast a struct sockaddr_in6 * into addr for ipv6 */
327
328 LWS_VISIBLE int
329 lws_interface_to_sa(int ipv6, const char *ifname, struct sockaddr_in *addr,
330                     size_t addrlen)
331 {
332 #if 0
333         int rc = -1;
334
335         struct ifaddrs *ifr;
336         struct ifaddrs *ifc;
337 #ifdef LWS_USE_IPV6
338         struct sockaddr_in6 *addr6 = (struct sockaddr_in6 *)addr;
339 #endif
340
341         getifaddrs(&ifr);
342         for (ifc = ifr; ifc != NULL && rc; ifc = ifc->ifa_next) {
343                 if (!ifc->ifa_addr)
344                         continue;
345
346                 lwsl_info(" interface %s vs %s\n", ifc->ifa_name, ifname);
347
348                 if (strcmp(ifc->ifa_name, ifname))
349                         continue;
350
351                 switch (ifc->ifa_addr->sa_family) {
352                 case AF_INET:
353 #ifdef LWS_USE_IPV6
354                         if (ipv6) {
355                                 /* map IPv4 to IPv6 */
356                                 bzero((char *)&addr6->sin6_addr,
357                                                 sizeof(struct in6_addr));
358                                 addr6->sin6_addr.s6_addr[10] = 0xff;
359                                 addr6->sin6_addr.s6_addr[11] = 0xff;
360                                 memcpy(&addr6->sin6_addr.s6_addr[12],
361                                         &((struct sockaddr_in *)ifc->ifa_addr)->sin_addr,
362                                                         sizeof(struct in_addr));
363                         } else
364 #endif
365                                 memcpy(addr,
366                                         (struct sockaddr_in *)ifc->ifa_addr,
367                                                     sizeof(struct sockaddr_in));
368                         break;
369 #ifdef LWS_USE_IPV6
370                 case AF_INET6:
371                         memcpy(&addr6->sin6_addr,
372                           &((struct sockaddr_in6 *)ifc->ifa_addr)->sin6_addr,
373                                                        sizeof(struct in6_addr));
374                         break;
375 #endif
376                 default:
377                         continue;
378                 }
379                 rc = 0;
380         }
381
382         freeifaddrs(ifr);
383
384         if (rc == -1) {
385                 /* check if bind to IP address */
386 #ifdef LWS_USE_IPV6
387                 if (inet_pton(AF_INET6, ifname, &addr6->sin6_addr) == 1)
388                         rc = 0;
389                 else
390 #endif
391                 if (inet_pton(AF_INET, ifname, &addr->sin_addr) == 1)
392                         rc = 0;
393         }
394
395         return rc;
396 #endif
397
398         return -1;
399 }
400
401 LWS_VISIBLE void
402 lws_plat_insert_socket_into_fds(struct lws_context *context, struct lws *wsi)
403 {
404         struct lws_context_per_thread *pt = &context->pt[(int)wsi->tsi];
405
406         pt->fds[pt->fds_count++].revents = 0;
407 }
408
409 LWS_VISIBLE void
410 lws_plat_delete_socket_from_fds(struct lws_context *context,
411                                                 struct lws *wsi, int m)
412 {
413         struct lws_context_per_thread *pt = &context->pt[(int)wsi->tsi];
414
415         pt->fds_count--;
416 }
417
418 LWS_VISIBLE void
419 lws_plat_service_periodic(struct lws_context *context)
420 {
421 }
422
423 LWS_VISIBLE int
424 lws_plat_change_pollfd(struct lws_context *context,
425                       struct lws *wsi, struct lws_pollfd *pfd)
426 {
427         return 0;
428 }
429
430 LWS_VISIBLE const char *
431 lws_plat_inet_ntop(int af, const void *src, char *dst, int cnt)
432 {
433         return inet_ntop(af, src, dst, cnt);
434 }
435
436 LWS_VISIBLE lws_fop_fd_t IRAM_ATTR
437 _lws_plat_file_open(const struct lws_plat_file_ops *fops, const char *filename,
438                     const char *vpath, lws_fop_flags_t *flags)
439 {
440         struct stat stat_buf;
441         lws_fop_fd_t fop_fd;
442         int ret = open(filename, *flags, 0664);
443
444         if (ret < 0)
445                 return NULL;
446
447         if (fstat(ret, &stat_buf) < 0)
448                 goto bail;
449
450         fop_fd = malloc(sizeof(*fop_fd));
451         if (!fop_fd)
452                 goto bail;
453
454         fop_fd->fops = fops;
455         fop_fd->fd = ret;
456         fop_fd->flags = *flags;
457         fop_fd->filesystem_priv = NULL; /* we don't use it */
458         fop_fd->pos = 0;
459         fop_fd->len = stat_buf.st_size;
460
461         return fop_fd;
462
463 bail:
464         close(ret);
465
466         return NULL;
467 }
468
469 LWS_VISIBLE int IRAM_ATTR
470 _lws_plat_file_close(lws_fop_fd_t *fops_fd)
471 {
472         int fd = (*fops_fd)->fd;
473
474         free(*fops_fd);
475         *fops_fd = NULL;
476
477         return close(fd);
478 }
479
480 LWS_VISIBLE lws_fileofs_t IRAM_ATTR
481 _lws_plat_file_seek_cur(lws_fop_fd_t fops_fd, lws_fileofs_t offset)
482 {
483         return lseek(fops_fd->fd, offset, SEEK_CUR);
484 }
485
486 LWS_VISIBLE int IRAM_ATTR
487 _lws_plat_file_read(lws_fop_fd_t fops_fd, lws_filepos_t *amount,
488                     uint8_t *buf, lws_filepos_t len)
489 {
490         long n;
491
492         n = read(fops_fd->fd, buf, len);
493         if (n == -1) {
494                 *amount = 0;
495                 return -1;
496         }
497         fops_fd->pos += n;
498         *amount = n;
499
500         return 0;
501 }
502
503 LWS_VISIBLE int IRAM_ATTR
504 _lws_plat_file_write(lws_fop_fd_t fops_fd, lws_filepos_t *amount,
505                      uint8_t *buf, lws_filepos_t len)
506 {
507         long n;
508
509         n = write(fops_fd->fd, buf, len);
510         if (n == -1) {
511                 *amount = 0;
512                 return -1;
513         }
514         fops_fd->pos += n;
515         *amount = n;
516
517         return 0;
518 }
519
520
521 LWS_VISIBLE int
522 lws_plat_init(struct lws_context *context,
523               struct lws_context_creation_info *info)
524 {
525         /* master context has the global fd lookup array */
526         context->lws_lookup = lws_zalloc(sizeof(struct lws *) *
527                                          context->max_fds);
528         if (context->lws_lookup == NULL) {
529                 lwsl_err("OOM on lws_lookup array for %d connections\n",
530                          context->max_fds);
531                 return 1;
532         }
533
534         lwsl_notice(" mem: platform fd map: %5lu bytes\n",
535                     (unsigned long)(sizeof(struct lws *) * context->max_fds));
536
537 #ifdef LWS_WITH_PLUGINS
538         if (info->plugin_dirs)
539                 lws_plat_plugins_init(context, info->plugin_dirs);
540 #endif
541
542         return 0;
543 }
544
545
546 LWS_VISIBLE void esp32_uvtimer_cb(TimerHandle_t t)
547 {
548         struct timer_mapping *p = pvTimerGetTimerID(t);
549
550         p->cb(p->t);
551 }
552
553 void ERR_error_string_n(unsigned long e, char *buf, size_t len)
554 {
555         strncpy(buf, "unknown", len);
556 }
557
558 void ERR_free_strings(void)
559 {
560 }
561
562 char *ERR_error_string(unsigned long e, char *buf)
563 {
564         if (buf)
565                 strcpy(buf, "unknown");
566
567         return "unknown";
568 }
569
570
571 /* helper functionality */
572
573 #include "romfs.h"
574 #include <esp_ota_ops.h>
575 #include <tcpip_adapter.h>
576 #include <esp_image_format.h>
577 #include <esp_task_wdt.h>
578 #include "soc/ledc_reg.h"
579 #include "driver/ledc.h"
580
581 struct lws_esp32 lws_esp32 = {
582         .model = CONFIG_LWS_MODEL_NAME,
583         .serial = "unknown",
584         .region = WIFI_COUNTRY_US, // default to safest option
585 };
586
587 /*
588  * Group AP / Station State
589  */
590
591 enum lws_gapss {
592         LWS_GAPSS_INITIAL,      /* just started up, init and move to LWS_GAPSS_SCAN */
593         LWS_GAPSS_SCAN,         /*
594                                  * Unconnected, scanning: AP known in one of the config
595                                  * slots -> configure it, start timeout + LWS_GAPSS_STAT,
596                                  * if no AP already up in same group with lower MAC,
597                                  * after a random period start up our AP (LWS_GAPSS_AP)
598                                  */
599         LWS_GAPSS_AP,           /*
600                                  * Trying to be the group AP... periodically do a scan
601                                  * LWS_GAPSS_AP_SCAN, faster and then slower
602                                  */
603         LWS_GAPSS_AP_SCAN,      /*
604                                  * doing a scan while trying to be the group AP... if
605                                  * we see a lower MAC being the AP for the same group
606                                  * AP, abandon being an AP and join that AP as a
607                                  * station
608                                  */
609         LWS_GAPSS_STAT_GRP_AP,  /*
610                                  * We have decided to join another group member who is
611                                  * being the AP, as its MAC is lower than ours.  This
612                                  * is a stable state, but we still do periodic scans
613                                  * (LWS_GAPSS_STAT_GRP_AP_SCAN) and will always prefer
614                                  * an AP configured in a slot.
615                                  */
616         LWS_GAPSS_STAT_GRP_AP_SCAN,
617                                 /*
618                                  * We have joined a group member who is doing the AP
619                                  * job... we want to check every now and then if a
620                                  * configured AP has appeared that we should better
621                                  * use instead.  Otherwise stay in LWS_GAPSS_STAT_GRP_AP
622                                  */
623         LWS_GAPSS_STAT,         /*
624                                  * trying to connect to another non-group AP.  If we
625                                  * don't get an IP within a timeout and retries,
626                                  * blacklist it and go back 
627                                  */
628         LWS_GAPSS_STAT_HAPPY,
629 };
630
631 static const char *gapss_str[] = {
632         "LWS_GAPSS_INITIAL",
633         "LWS_GAPSS_SCAN",
634         "LWS_GAPSS_AP",
635         "LWS_GAPSS_AP_SCAN",
636         "LWS_GAPSS_STAT_GRP_AP",
637         "LWS_GAPSS_STAT_GRP_AP_SCAN",
638         "LWS_GAPSS_STAT",
639         "LWS_GAPSS_STAT_HAPPY",
640 };
641
642 static romfs_t lws_esp32_romfs;
643 static TimerHandle_t leds_timer, scan_timer, debounce_timer
644 #if !defined(CONFIG_LWS_IS_FACTORY_APPLICATION)
645 , mdns_timer
646 #endif
647 ;
648 static enum lws_gapss gapss = LWS_GAPSS_INITIAL;
649 static char bdown;
650
651 #define GPIO_SW 14
652
653 struct esp32_file {
654         const struct inode *i;
655 };
656
657 static void lws_gapss_to(enum lws_gapss to)
658 {
659         lwsl_notice("gapss from %s to %s\n", gapss_str[gapss], gapss_str[to]);
660         gapss = to;
661 }
662
663 uint32_t lws_esp32_get_reboot_type(void)
664 {
665         uint32_t *p = (uint32_t *)LWS_MAGIC_REBOOT_TYPE_ADS, val = *p;
666         nvs_handle nvh;
667         size_t s = 0;
668         int n = 0;
669
670         ESP_ERROR_CHECK(nvs_open("lws-station", NVS_READWRITE, &nvh));
671         if (nvs_get_blob(nvh, "ssl-pub.pem", NULL, &s) == ESP_OK)
672                 n = 1;
673         if (nvs_get_blob(nvh, "ssl-pri.pem", NULL, &s) == ESP_OK)
674                 n |= 2;
675         nvs_close(nvh);
676
677         /*
678          * in the case the SSL certs are not there, don't require
679          * the button to be down to access all features.
680          */
681         if (n != 3)
682                 val = LWS_MAGIC_REBOOT_TYPE_FORCED_FACTORY_BUTTON;
683
684         return val;
685 }
686
687 static void render_ip(char *dest, int len, uint8_t *ip)
688 {
689         snprintf(dest, len, "%u.%u.%u.%u", ip[0], ip[1], ip[2], ip[3]);
690 }
691
692 void lws_esp32_restart_guided(uint32_t type)
693 {
694         uint32_t *p_force_factory_magic = (uint32_t *)LWS_MAGIC_REBOOT_TYPE_ADS;
695
696         lwsl_notice("%s: %x\n", __func__, type);
697         *p_force_factory_magic = type;
698
699         esp_restart();
700 }
701
702 /*
703  * esp-idf goes crazy with zero length str nvs.  Use this as a workaround
704  * to delete the key in that case.
705  */
706
707 esp_err_t lws_nvs_set_str(nvs_handle handle, const char* key, const char* value)
708 {
709         if (*value)
710                 return nvs_set_str(handle, key, value);
711
712         return nvs_erase_key(handle, key);
713 }
714
715 static wifi_scan_config_t scan_config = {
716         .ssid = 0,
717         .bssid = 0,
718         .channel = 0,
719         .show_hidden = true
720 };
721
722 static char scan_ongoing = 0, scan_timer_exists = 0;
723 static int try_slot = -1;
724
725 static wifi_config_t config = {
726         .ap = {
727             .channel = 6,
728             .authmode = WIFI_AUTH_OPEN,
729             .max_connection = 1,
730         } }, sta_config = {
731         .sta = {
732                 .bssid_set = 0,
733         } };
734
735 static void lws_esp32_scan_timer_cb(TimerHandle_t th)
736 {
737         int n;
738
739         lwsl_notice("%s\n", __func__);
740         scan_ongoing = 0;
741         n = esp_wifi_scan_start(&scan_config, false);
742         if (n != ESP_OK)
743                 lwsl_err("scan start failed %d\n", n);
744 }
745
746 #if !defined(CONFIG_LWS_IS_FACTORY_APPLICATION)
747
748 void __attribute__(( weak ))
749 lws_group_member_event(int e, void *p)
750 {
751 }
752
753 void __attribute__(( weak ))
754 lws_get_iframe_size(int *w, int *h)
755 {
756         *w = 320;
757         *h = 160;
758 }
759
760 void lws_group_member_event_call(int e, void *p)
761 {
762         lws_group_member_event(e, p);
763 }
764
765 static int
766 get_txt_param(const char *txt, const char *param, char *result, int len)
767 {
768         const char *p;
769
770 again:
771         p = strstr(txt, param);
772         if (!p) {
773                 *result = '\0';
774                 return 1;
775         }
776
777         p += strlen(param);
778         if (*p != '=') {
779                 txt = p;
780                 goto again;
781         }
782         p++;
783         while (*p && *p != '&' && --len)
784                 *result++ = *p++;
785
786         *result = '\0';
787
788         return 0;
789 }
790
791 void __attribute__(( weak ))
792 lws_esp32_button(int down)
793 {
794 }
795
796 void IRAM_ATTR
797 gpio_irq(void *arg)
798 {
799         bdown ^= 1;
800         gpio_set_intr_type(GPIO_SW, GPIO_INTR_DISABLE);
801         xTimerStart(debounce_timer, 0);
802
803         lws_esp32_button(bdown);
804 }
805
806 static void lws_esp32_debounce_timer_cb(TimerHandle_t th)
807 {
808         if (bdown)
809                 gpio_set_intr_type(GPIO_SW, GPIO_INTR_POSEDGE);
810         else
811                 gpio_set_intr_type(GPIO_SW, GPIO_INTR_NEGEDGE);
812 }
813
814 static void lws_esp32_mdns_timer_cb(TimerHandle_t th)
815 {
816         uint64_t now = time_in_microseconds(); 
817         struct lws_group_member *p, **p1;
818         const mdns_result_t *r;
819         int n, m;
820
821         if (!lws_esp32.mdns)
822                 return;
823         n = mdns_query_end(lws_esp32.mdns);
824
825         for (m = 0; m < n; m++) {
826                 char ch = 0, group[16];
827
828                 r = mdns_result_get(lws_esp32.mdns, m);
829
830                 get_txt_param(r->txt, "group", group, sizeof(group));
831                 if (strcmp(group, lws_esp32.group)) /* not our group */ {
832                         lwsl_notice("group %s vs %s  %s\n",
833                                         group, lws_esp32.group, r->txt);
834                         continue;
835                 }
836
837                 p = lws_esp32.first;
838                 while (p) {
839                         if (strcmp(r->host, p->host))
840                                 goto next;
841                         if (memcmp(&r->addr, &p->addr, sizeof(r->addr)))
842                                 goto next;
843
844                         p->last_seen = now;
845                         break;
846 next:
847                         p = p->next;
848                 }
849                 if (!p) { /* did not find */
850                         char temp[8];
851                         p = malloc(sizeof(*p));
852                         if (!p)
853                                 continue;
854                         strncpy(p->host, r->host, sizeof(p->host) - 1);
855                         p->host[sizeof(p->host) - 1] = '\0';
856
857                         get_txt_param(r->txt, "model", p->model, sizeof(p->model));
858                         get_txt_param(r->txt, "role", p->role, sizeof(p->role));
859                         get_txt_param(r->txt, "mac", p->mac, sizeof(p->mac));
860                         get_txt_param(r->txt, "width", temp, sizeof(temp));
861                         p->width = atoi(temp);
862                         get_txt_param(r->txt, "height", temp, sizeof(temp));
863                         p->height = atoi(temp);
864
865                         memcpy(&p->addr, &r->addr, sizeof(p->addr));
866                         memcpy(&p->addrv6, &r->addrv6, sizeof(p->addrv6));
867                         p->last_seen = now;
868                         p->flags = 0;
869                         p->next = lws_esp32.first;
870                         lws_esp32.first = p;
871                         lws_esp32.extant_group_members++;
872
873                         lws_group_member_event_call(LWS_SYSTEM_GROUP_MEMBER_ADD, p);
874                 } else {
875                         if (memcmp(&p->addr, &r->addr, sizeof(p->addr))) {
876                                 memcpy(&p->addr, &r->addr, sizeof(p->addr));
877                                 ch = 1;
878                         }
879                         if (memcmp(&p->addrv6, &r->addrv6, sizeof(p->addrv6))) {
880                                 memcpy(&p->addrv6, &r->addrv6, sizeof(p->addrv6));
881                                 ch = 1;
882                         }
883                         if (ch)
884                                 lws_group_member_event_call(LWS_SYSTEM_GROUP_MEMBER_CHANGE, p);
885                 }
886         }
887
888         mdns_result_free(lws_esp32.mdns);
889
890         /* garbage-collect group members not seen for too long */
891         p1 = &lws_esp32.first;
892         while (*p1) {
893                 p = *p1;
894                 if (!(p->flags & LWS_GROUP_FLAG_SELF) &&
895                                 now - p->last_seen > 60000000) {
896                         lws_esp32.extant_group_members--;
897                         *p1 = p->next;
898
899                         lws_group_member_event_call(LWS_SYSTEM_GROUP_MEMBER_REMOVE, p);
900                         free(p);
901                         continue;
902                 }
903                 p1 = &(*p1)->next;
904         }
905
906         mdns_query(lws_esp32.mdns, "_lwsgrmem", "_tcp", 0);
907         xTimerStart(mdns_timer, 0);
908 }
909 #endif
910
911 static int
912 start_scan()
913 {
914         /* if no APs configured, no point... */
915
916         if (!lws_esp32.ssid[0][0] &&
917             !lws_esp32.ssid[1][0] &&
918             !lws_esp32.ssid[2][0] &&
919             !lws_esp32.ssid[3][0])
920                 return 0;
921
922         if (scan_timer_exists && !scan_ongoing) {
923                 // lwsl_notice("Starting scan timer...\n");
924                 scan_ongoing = 1;
925                 xTimerStart(scan_timer, 0);
926         }
927
928         return 0;
929 }
930
931
932
933 static void
934 end_scan()
935 {
936         wifi_ap_record_t ap_records[10];
937         uint16_t count_ap_records;
938         int n, m;
939
940         count_ap_records = ARRAY_SIZE(ap_records);
941         if (esp_wifi_scan_get_ap_records(&count_ap_records, ap_records) != ESP_OK) {
942                 lwsl_err("%s: failed\n", __func__);
943                 return;
944         }
945
946         if (!count_ap_records)
947                 goto passthru;
948
949         if (gapss != LWS_GAPSS_SCAN) {
950                 lwsl_notice("ignoring scan as gapss %s\n", gapss_str[gapss]);
951                 goto passthru;
952         }
953
954         /* no point if no APs set up */
955         if (!lws_esp32.ssid[0][0] &&
956             !lws_esp32.ssid[1][0] &&
957             !lws_esp32.ssid[2][0] &&
958             !lws_esp32.ssid[3][0])
959                 goto passthru;
960
961         lwsl_notice("checking %d scan records\n", count_ap_records);
962
963         for (n = 0; n < 4; n++) {
964
965                 if (!lws_esp32.ssid[(n + try_slot + 1) & 3][0])
966                         continue;
967
968                 lwsl_notice("looking for %s\n", lws_esp32.ssid[(n + try_slot + 1) & 3]);
969
970                 /* this ssid appears in scan results? */
971
972                 for (m = 0; m < count_ap_records; m++) {
973                         // lwsl_notice("  %s\n", ap_records[m].ssid);
974                         if (strcmp((char *)ap_records[m].ssid, lws_esp32.ssid[(n + try_slot + 1) & 3]) == 0)
975                                 goto hit;
976                 }
977
978                 continue;
979
980 hit:
981                 m = (n + try_slot + 1) & 3;
982                 try_slot = m;
983                 lwsl_notice("Attempting connection with slot %d: %s:\n", m,
984                                 lws_esp32.ssid[m]);
985                 /* set the ssid we last tried to connect to */
986                 strncpy(lws_esp32.active_ssid, lws_esp32.ssid[m],
987                                 sizeof(lws_esp32.active_ssid) - 1);
988                 lws_esp32.active_ssid[sizeof(lws_esp32.active_ssid) - 1] = '\0';
989
990                 strncpy((char *)sta_config.sta.ssid, lws_esp32.ssid[m], sizeof(sta_config.sta.ssid) - 1);
991                 strncpy((char *)sta_config.sta.password, lws_esp32.password[m], sizeof(sta_config.sta.password) - 1);
992
993                 tcpip_adapter_set_hostname(TCPIP_ADAPTER_IF_STA, (const char *)&config.ap.ssid[7]);
994                 lws_gapss_to(LWS_GAPSS_STAT);
995
996                 esp_wifi_set_config(WIFI_IF_STA, &sta_config);
997                 esp_wifi_connect();
998                 break;
999         }
1000
1001         if (n == 4)
1002                 start_scan();
1003
1004 passthru:
1005         if (lws_esp32.scan_consumer)
1006                 lws_esp32.scan_consumer(count_ap_records, ap_records, lws_esp32.scan_consumer_arg);
1007
1008 }
1009
1010 static void
1011 lws_set_genled(int n)
1012 {
1013         lws_esp32.genled_t = time_in_microseconds();
1014         lws_esp32.genled = n;
1015 }
1016
1017 int
1018 lws_esp32_leds_network_indication(void)
1019 {
1020         uint64_t us, r;
1021         int n, fadein = 100, speed = 1199, div = 1, base = 0;
1022
1023         r = time_in_microseconds();
1024         us = r - lws_esp32.genled_t;
1025
1026         switch (lws_esp32.genled) {
1027         case LWSESP32_GENLED__INIT:
1028                 lws_esp32.genled = LWSESP32_GENLED__LOST_NETWORK;
1029                 /* fallthru */
1030         case LWSESP32_GENLED__LOST_NETWORK:
1031                 fadein = us / 10000; /* 100 steps in 1s */
1032                 if (fadein > 100) {
1033                         fadein = 100;
1034                         lws_esp32.genled = LWSESP32_GENLED__NO_NETWORK;
1035                 }
1036                 /* fallthru */
1037         case LWSESP32_GENLED__NO_NETWORK:
1038                 break;
1039         case LWSESP32_GENLED__CONN_AP:
1040                 base = 4096;
1041                 speed = 933;
1042                 div = 2;
1043                 break;
1044         case LWSESP32_GENLED__GOT_IP:
1045                 fadein = us / 10000; /* 100 steps in 1s */
1046                 if (fadein > 100) {
1047                         fadein = 100;
1048                         lws_esp32.genled = LWSESP32_GENLED__OK;
1049                 }
1050                 fadein = 100 - fadein; /* we are fading out */
1051                 /* fallthru */
1052         case LWSESP32_GENLED__OK:
1053                 if (lws_esp32.genled == LWSESP32_GENLED__OK)
1054                         return 0;
1055
1056                 base = 4096;
1057                 speed = 766;
1058                 div = 3;
1059                 break;
1060         }
1061
1062         n = base + (lws_esp32_sine_interp(r / speed) / div);
1063         return (n * fadein) / 100;
1064 }
1065
1066 esp_err_t lws_esp32_event_passthru(void *ctx, system_event_t *event)
1067 {
1068 #if !defined(CONFIG_LWS_IS_FACTORY_APPLICATION)
1069         struct lws_group_member *mem;
1070         int n;
1071 #endif
1072         char slot[8];
1073         nvs_handle nvh;
1074         uint32_t use;
1075
1076         switch((int)event->event_id) {
1077         case SYSTEM_EVENT_STA_START:
1078                 //esp_wifi_connect();
1079 //              break;
1080                 /* fallthru */
1081         case SYSTEM_EVENT_STA_DISCONNECTED:
1082                 lwsl_notice("SYSTEM_EVENT_STA_DISCONNECTED\n");
1083                 lws_esp32.conn_ap = 0;
1084                 lws_esp32.inet = 0;
1085                 lws_esp32.sta_ip[0] = '\0';
1086                 lws_esp32.sta_mask[0] = '\0';
1087                 lws_esp32.sta_gw[0] = '\0';
1088                 lws_gapss_to(LWS_GAPSS_SCAN);
1089                 if (lws_esp32.mdns)
1090                         mdns_service_remove_all(lws_esp32.mdns);
1091                 mdns_free(lws_esp32.mdns);
1092                 lws_esp32.mdns = NULL;
1093                 lws_set_genled(LWSESP32_GENLED__LOST_NETWORK);
1094                 start_scan();
1095                 esp_wifi_connect();
1096                 break;
1097
1098         case SYSTEM_EVENT_STA_CONNECTED:
1099                 lws_esp32.conn_ap = 1;
1100                 lws_set_genled(LWSESP32_GENLED__CONN_AP);
1101                 break;
1102
1103         case SYSTEM_EVENT_STA_GOT_IP:
1104                 lwsl_notice("SYSTEM_EVENT_STA_GOT_IP\n");
1105
1106                 lws_esp32.inet = 1;
1107                 lws_set_genled(LWSESP32_GENLED__GOT_IP);
1108
1109                 render_ip(lws_esp32.sta_ip, sizeof(lws_esp32.sta_ip) - 1,
1110                                 (uint8_t *)&event->event_info.got_ip.ip_info.ip);
1111                 render_ip(lws_esp32.sta_mask, sizeof(lws_esp32.sta_mask) - 1,
1112                                 (uint8_t *)&event->event_info.got_ip.ip_info.netmask);
1113                 render_ip(lws_esp32.sta_gw, sizeof(lws_esp32.sta_gw) - 1,
1114                                 (uint8_t *)&event->event_info.got_ip.ip_info.gw);
1115
1116                 if (!nvs_open("lws-station", NVS_READWRITE, &nvh)) {
1117                         lws_snprintf(slot, sizeof(slot) - 1, "%duse", try_slot);
1118                         use = 0;
1119                         nvs_get_u32(nvh, slot, &use);
1120                         nvs_set_u32(nvh, slot, use + 1);
1121                         nvs_commit(nvh);
1122                         nvs_close(nvh);
1123                 }
1124
1125                 lws_gapss_to(LWS_GAPSS_STAT_HAPPY);
1126
1127 #if !defined(CONFIG_LWS_IS_FACTORY_APPLICATION)
1128                 n = mdns_init(TCPIP_ADAPTER_IF_STA, &lws_esp32.mdns);
1129                 if (!n) {
1130                         static char *txta[6];
1131                         int w, h;
1132
1133                         mdns_set_hostname(lws_esp32.mdns, lws_esp32.hostname);
1134                         mdns_set_instance(lws_esp32.mdns, lws_esp32.group);
1135                         mdns_service_add(lws_esp32.mdns, "_lwsgrmem", "_tcp", 443);
1136                         if (txta[0])
1137                                 free(txta[0]);
1138                         txta[0] = malloc(32 * ARRAY_SIZE(txta));
1139                         if (!txta[0]) {
1140                                 lwsl_notice("mdns OOM\n");
1141                                 break;
1142                         }
1143                         txta[1] = &txta[0][32];
1144                         txta[2] = &txta[1][32];
1145                         txta[3] = &txta[2][32];
1146                         txta[4] = &txta[3][32];
1147                         txta[5] = &txta[4][32];
1148
1149                         lws_get_iframe_size(&w, &h);
1150
1151                         lws_snprintf(txta[0], 31, "model=%s", lws_esp32.model);
1152                         lws_snprintf(txta[1], 31, "group=%s", lws_esp32.group);
1153                         lws_snprintf(txta[2], 31, "role=%s", lws_esp32.role);
1154                         lws_snprintf(txta[3], 31, "mac=%s", lws_esp32.mac);
1155                         lws_snprintf(txta[4], 31, "width=%d", w);
1156                         lws_snprintf(txta[5], 31, "height=%d", h);
1157
1158                         mem = lws_esp32.first;
1159                         while (mem) {
1160                                 if (mem->flags & 1)
1161                                         break;
1162                                 mem = mem->next;
1163                         }
1164
1165                         if (!mem) {
1166                                 struct lws_group_member *mem = malloc(sizeof(*mem));
1167                                 if (mem) {
1168                                         mem->last_seen = ~(uint64_t)0;
1169                                         strcpy(mem->model, lws_esp32.model);
1170                                         strcpy(mem->role, lws_esp32.role);
1171                                         strcpy(mem->host, lws_esp32.hostname);
1172                                         strcpy(mem->mac, lws_esp32.mac);
1173                                         mem->flags = LWS_GROUP_FLAG_SELF;
1174                                         lws_get_iframe_size(&mem->width, &mem->height);
1175                                         memcpy(&mem->addr, &event->event_info.got_ip.ip_info.ip,
1176                                                         sizeof(mem->addr));
1177                                         memcpy(&mem->addrv6, &event->event_info.got_ip6.ip6_info.ip,
1178                                                         sizeof(mem->addrv6));
1179                                         mem->next = lws_esp32.first;
1180                                         lws_esp32.first = mem;
1181                                         lws_esp32.extant_group_members++;
1182
1183                                         lws_group_member_event_call(LWS_SYSTEM_GROUP_MEMBER_ADD, mem);
1184                                 }
1185                         } else { /* update our IP */
1186                                         memcpy(&mem->addr, &event->event_info.got_ip.ip_info.ip,
1187                                                         sizeof(mem->addr));
1188                                         memcpy(&mem->addrv6, &event->event_info.got_ip6.ip6_info.ip,
1189                                                         sizeof(mem->addrv6));
1190                                         lws_group_member_event_call(LWS_SYSTEM_GROUP_MEMBER_CHANGE, mem);
1191                         }
1192
1193
1194                         if (mdns_service_txt_set(lws_esp32.mdns, "_lwsgrmem", "_tcp", ARRAY_SIZE(txta),
1195                                                  (const char **)txta))
1196                                 lwsl_notice("txt set failed\n");
1197                 } else
1198                         lwsl_err("unable to init mdns on STA: %d\n", n);
1199
1200                 mdns_query(lws_esp32.mdns, "_lwsgrmem", "_tcp", 0);
1201                 xTimerStart(mdns_timer, 0);
1202 #endif
1203
1204                 lwsl_notice(" --- Got IP %s\n", lws_esp32.sta_ip);
1205                 break;
1206
1207         case SYSTEM_EVENT_SCAN_DONE:
1208                 lwsl_notice("SYSTEM_EVENT_SCAN_DONE\n");
1209                 end_scan();
1210                 break;
1211
1212         default:
1213                 break;
1214         }
1215
1216         return ESP_OK;
1217 }
1218
1219 static lws_fop_fd_t IRAM_ATTR
1220 esp32_lws_fops_open(const struct lws_plat_file_ops *fops, const char *filename,
1221                 const char *vfs_path, lws_fop_flags_t *flags)
1222 {
1223         struct esp32_file *f = malloc(sizeof(*f));
1224         lws_fop_fd_t fop_fd;
1225         size_t len, csum;
1226
1227         lwsl_notice("%s: %s\n", __func__, filename);
1228
1229         if (!f)
1230                 return NULL;
1231         f->i = romfs_get_info(lws_esp32_romfs, filename, &len, &csum);
1232         if (!f->i)
1233                 goto bail;
1234
1235         fop_fd = malloc(sizeof(*fop_fd));
1236         if (!fop_fd)
1237                 goto bail;
1238
1239         fop_fd->fops = fops;
1240         fop_fd->filesystem_priv = f;
1241         fop_fd->mod_time = csum;
1242         *flags |= LWS_FOP_FLAG_MOD_TIME_VALID;
1243         fop_fd->flags = *flags;
1244         
1245         fop_fd->len = len;
1246         fop_fd->pos = 0;
1247
1248         return fop_fd;
1249
1250 bail:
1251         free(f);
1252
1253         return NULL;
1254 }
1255
1256 static int IRAM_ATTR
1257 esp32_lws_fops_close(lws_fop_fd_t *fop_fd)
1258 {
1259         free((*fop_fd)->filesystem_priv);
1260         free(*fop_fd);
1261
1262         *fop_fd = NULL;
1263
1264         return 0;
1265 }
1266 static lws_fileofs_t IRAM_ATTR
1267 esp32_lws_fops_seek_cur(lws_fop_fd_t fop_fd, lws_fileofs_t offset_from_cur_pos)
1268 {
1269         fop_fd->pos += offset_from_cur_pos;
1270         
1271         if (fop_fd->pos > fop_fd->len)
1272                 fop_fd->pos = fop_fd->len;
1273
1274        return 0;
1275 }
1276
1277 static int IRAM_ATTR
1278 esp32_lws_fops_read(lws_fop_fd_t fop_fd, lws_filepos_t *amount, uint8_t *buf,
1279                    lws_filepos_t len)
1280 {
1281        struct esp32_file *f = fop_fd->filesystem_priv;
1282 #if 0
1283        if ((long)buf & 3) {
1284                lwsl_err("misaligned buf\n");
1285
1286                return -1;
1287        }
1288 #endif
1289        if (fop_fd->pos >= fop_fd->len)
1290                return 0;
1291
1292        if (len > fop_fd->len - fop_fd->pos)
1293                len = fop_fd->len - fop_fd->pos;
1294
1295        spi_flash_read((uint32_t)(char *)f->i + fop_fd->pos, buf, len);
1296
1297        *amount = len;
1298        fop_fd->pos += len;
1299
1300        return 0;
1301 }
1302
1303 static const struct lws_plat_file_ops fops = {
1304         .next = &fops_zip,
1305         .LWS_FOP_OPEN = esp32_lws_fops_open,
1306         .LWS_FOP_CLOSE = esp32_lws_fops_close,
1307         .LWS_FOP_READ = esp32_lws_fops_read,
1308         .LWS_FOP_SEEK_CUR = esp32_lws_fops_seek_cur,
1309 };
1310
1311 int
1312 lws_esp32_wlan_nvs_get(int retry)
1313 {
1314         nvs_handle nvh;
1315         char r[2], lws_esp32_force_ap = 0, slot[12];
1316         size_t s;
1317         uint8_t mac[6];
1318         int n;
1319
1320         esp_efuse_mac_get_default(mac);
1321         mac[5] |= 1; /* match the AP MAC */
1322         snprintf(lws_esp32.serial, sizeof(lws_esp32.serial) - 1, "%02X%02X%02X", mac[3], mac[4], mac[5]);
1323         snprintf(lws_esp32.mac, sizeof(lws_esp32.mac) - 1, "%02X%02X%02X%02X%02X%02X", mac[0],
1324                         mac[1], mac[2], mac[3], mac[4], mac[5]);
1325
1326         ESP_ERROR_CHECK(nvs_open("lws-station", NVS_READWRITE, &nvh));
1327
1328         config.sta.ssid[0] = '\0';
1329         config.sta.password[0] = '\0';
1330
1331         for (n = 0; n < 4; n++) {
1332                 lws_snprintf(slot, sizeof(slot) - 1, "%dssid", n);
1333                 s = sizeof(lws_esp32.ssid[0]) - 1;
1334                 lws_esp32.ssid[n][0] = '\0';
1335                 nvs_get_str(nvh, slot, lws_esp32.ssid[n], &s);
1336
1337                 lws_snprintf(slot, sizeof(slot) - 1, "%dpassword", n);
1338                 s = sizeof(lws_esp32.password[0]) - 1;
1339                 lws_esp32.password[n][0] = '\0';
1340                 nvs_get_str(nvh, slot, lws_esp32.password[n], &s);
1341         }
1342
1343         s = sizeof(lws_esp32.serial) - 1;
1344         if (nvs_get_str(nvh, "serial", lws_esp32.serial, &s) != ESP_OK)
1345                 lws_esp32_force_ap = 1;
1346         else
1347                 snprintf((char *)config.ap.ssid, sizeof(config.ap.ssid) - 1,
1348                          "config-%s-%s", lws_esp32.model, lws_esp32.serial);
1349         s = sizeof(lws_esp32.opts) - 1;
1350         if (nvs_get_str(nvh, "opts", lws_esp32.opts, &s) != ESP_OK)
1351                 lws_esp32_force_ap = 1;
1352
1353         s = sizeof(r);
1354         if (nvs_get_str(nvh, "region", r, &s) != ESP_OK)
1355                 lws_esp32_force_ap = 1;
1356         else
1357                 lws_esp32.region = atoi(r);
1358         lws_esp32.access_pw[0] = '\0';
1359         nvs_get_str(nvh, "access_pw", lws_esp32.access_pw, &s);
1360
1361         lws_esp32.group[0] = '\0';
1362         s = sizeof(lws_esp32.group);
1363         nvs_get_str(nvh, "group", lws_esp32.group, &s);
1364
1365         lws_esp32.role[0] = '\0';
1366         s = sizeof(lws_esp32.role);
1367         nvs_get_str(nvh, "role", lws_esp32.role, &s);
1368
1369         /* if group and role defined: group-role */
1370         if (lws_esp32.group[0] && lws_esp32.role[0])
1371                 lws_snprintf(lws_esp32.hostname, sizeof(lws_esp32.hostname) - 1,
1372                                 "%s-%s", lws_esp32.group, lws_esp32.role);
1373         else /* otherwise model-serial */
1374                 lws_snprintf(lws_esp32.hostname, sizeof(lws_esp32.hostname) - 1,
1375                                 "%s-%s", lws_esp32.model, lws_esp32.serial);
1376
1377         nvs_close(nvh);
1378
1379         lws_gapss_to(LWS_GAPSS_SCAN);
1380         start_scan();
1381
1382         return lws_esp32_force_ap;
1383 }
1384
1385
1386 void
1387 lws_esp32_wlan_config(void)
1388 {
1389         ledc_timer_config_t ledc_timer = {
1390                 .bit_num = LEDC_TIMER_13_BIT,
1391                 .freq_hz = 5000,
1392                 .speed_mode = LEDC_HIGH_SPEED_MODE,
1393                 .timer_num = LEDC_TIMER_0
1394         };
1395         int n;
1396
1397         ledc_timer_config(&ledc_timer);
1398
1399         lws_set_genled(LWSESP32_GENLED__INIT);
1400
1401         /* user code needs to provide lws_esp32_leds_timer_cb */
1402
1403         leds_timer = xTimerCreate("lws_leds", pdMS_TO_TICKS(25), 1, NULL,
1404                           (TimerCallbackFunction_t)lws_esp32_leds_timer_cb);
1405         scan_timer = xTimerCreate("lws_scan", pdMS_TO_TICKS(10000), 0, NULL,
1406                           (TimerCallbackFunction_t)lws_esp32_scan_timer_cb);
1407         debounce_timer = xTimerCreate("lws_db", pdMS_TO_TICKS(100), 0, NULL,
1408                           (TimerCallbackFunction_t)lws_esp32_debounce_timer_cb);
1409
1410 #if !defined(CONFIG_LWS_IS_FACTORY_APPLICATION)
1411         mdns_timer = xTimerCreate("lws_mdns", pdMS_TO_TICKS(5000), 0, NULL,
1412                           (TimerCallbackFunction_t)lws_esp32_mdns_timer_cb);
1413 #endif
1414         scan_timer_exists = 1;
1415         xTimerStart(leds_timer, 0);
1416
1417         *(volatile uint32_t *)PERIPHS_IO_MUX_MTMS_U = FUNC_MTMS_GPIO14;
1418
1419         gpio_output_set(0, 0, 0, (1 << GPIO_SW));
1420
1421         n = gpio_install_isr_service(0);
1422         if (!n) {
1423                 gpio_config_t c;
1424
1425                 c.intr_type = GPIO_INTR_NEGEDGE;
1426                 c.mode = GPIO_MODE_INPUT;
1427                 c.pin_bit_mask = 1 << GPIO_SW;
1428                 c.pull_down_en = 0;
1429                 c.pull_up_en = 0;
1430                 gpio_config(&c);
1431
1432                 if (gpio_isr_handler_add(GPIO_SW, gpio_irq, NULL))
1433                         lwsl_notice("isr handler add for 14 failed\n");
1434         } else
1435                 lwsl_notice("failed to install gpio isr service: %d\n", n);
1436
1437         lws_esp32_wlan_nvs_get(0);
1438         tcpip_adapter_init();
1439 }
1440
1441 void
1442 lws_esp32_wlan_start_ap(void)
1443 {
1444         wifi_init_config_t cfg = WIFI_INIT_CONFIG_DEFAULT();
1445
1446         ESP_ERROR_CHECK( esp_wifi_init(&cfg));
1447         ESP_ERROR_CHECK( esp_wifi_set_storage(WIFI_STORAGE_RAM));
1448         esp_wifi_set_country(lws_esp32.region);
1449
1450         ESP_ERROR_CHECK( esp_wifi_set_mode(WIFI_MODE_APSTA) );
1451         ESP_ERROR_CHECK( esp_wifi_set_config(WIFI_IF_AP, &config) );
1452         ESP_ERROR_CHECK( esp_wifi_set_config(WIFI_IF_STA, &sta_config));
1453         ESP_ERROR_CHECK( esp_wifi_start());
1454
1455         esp_wifi_scan_start(&scan_config, false);
1456
1457         if (sta_config.sta.ssid[0]) {
1458                 tcpip_adapter_set_hostname(TCPIP_ADAPTER_IF_STA, (const char *)&config.ap.ssid[7]);
1459                 esp_wifi_set_auto_connect(1);
1460                 ESP_ERROR_CHECK( esp_wifi_connect());
1461                 ESP_ERROR_CHECK( esp_wifi_set_config(WIFI_IF_STA, &sta_config));
1462                 ESP_ERROR_CHECK( esp_wifi_connect());
1463         }
1464 }
1465
1466 void
1467 lws_esp32_wlan_start_station(void)
1468 {
1469         wifi_init_config_t cfg = WIFI_INIT_CONFIG_DEFAULT();
1470
1471         ESP_ERROR_CHECK( esp_wifi_init(&cfg));
1472         ESP_ERROR_CHECK( esp_wifi_set_storage(WIFI_STORAGE_RAM));
1473         esp_wifi_set_country(lws_esp32.region);
1474
1475         ESP_ERROR_CHECK( esp_wifi_set_mode(WIFI_MODE_STA));
1476         ESP_ERROR_CHECK( esp_wifi_set_config(WIFI_IF_STA, &sta_config));
1477
1478         ESP_ERROR_CHECK( esp_wifi_start());
1479
1480         tcpip_adapter_set_hostname(TCPIP_ADAPTER_IF_STA, (const char *)&config.ap.ssid[7]);
1481         esp_wifi_set_auto_connect(1);
1482         ESP_ERROR_CHECK( esp_wifi_connect());
1483
1484         lws_esp32_scan_timer_cb(NULL);
1485 }
1486
1487 const esp_partition_t *
1488 lws_esp_ota_get_boot_partition(void)
1489 {
1490         const esp_partition_t *part = esp_ota_get_boot_partition(), *factory_part, *ota;
1491         esp_image_header_t eih, ota_eih;
1492         uint32_t *p_force_factory_magic = (uint32_t *)LWS_MAGIC_REBOOT_TYPE_ADS;
1493
1494         /* confirm what we are told is the boot part is sane */
1495         spi_flash_read(part->address , &eih, sizeof(eih));
1496         factory_part = esp_partition_find_first(ESP_PARTITION_TYPE_APP,
1497                         ESP_PARTITION_SUBTYPE_APP_FACTORY, NULL);
1498         ota = esp_partition_find_first(ESP_PARTITION_TYPE_APP,
1499                         ESP_PARTITION_SUBTYPE_APP_OTA_0, NULL);
1500         spi_flash_read(ota->address , &ota_eih, sizeof(ota_eih));
1501
1502         if (eih.spi_mode == 0xff ||
1503             *p_force_factory_magic == LWS_MAGIC_REBOOT_TYPE_FORCED_FACTORY ||
1504             *p_force_factory_magic == LWS_MAGIC_REBOOT_TYPE_FORCED_FACTORY_BUTTON
1505            ) {
1506                 /*
1507                  * we believed we were going to boot OTA, but we fell
1508                  * back to FACTORY in the bootloader when we saw it
1509                  * had been erased.  esp_ota_get_boot_partition() still
1510                  * says the OTA partition then even if we are in the
1511                  * factory partition right now.
1512                  */
1513                 part = factory_part;
1514         } 
1515         
1516 #ifdef CONFIG_LWS_IS_FACTORY_APPLICATION
1517         else
1518                 if (ota_eih.spi_mode != 0xff &&
1519                     part->address != factory_part->address) {
1520                         uint8_t buf[4096];
1521                         uint32_t n;
1522                         /*
1523                          * we are a FACTORY image running in an OTA slot...
1524                          * it means we were just written and need to copy
1525                          * ourselves into the FACTORY slot.
1526                          */
1527                         lwsl_notice("Copying FACTORY update into place 0x%x len 0x%x\n",
1528                                     factory_part->address, factory_part->size);
1529                         esp_task_wdt_feed();
1530                         if (spi_flash_erase_range(factory_part->address, factory_part->size) != ESP_OK) {
1531                                 lwsl_err("spi: Failed to erase\n");
1532                                 goto retry;
1533                         }
1534
1535                         for (n = 0; n < factory_part->size; n += sizeof(buf)) {
1536                                 esp_task_wdt_feed();
1537                                 spi_flash_read(part->address + n , buf, sizeof(buf));
1538                                 if (spi_flash_write(factory_part->address + n, buf, sizeof(buf)) != ESP_OK) {
1539                                         lwsl_err("spi: Failed to write\n");
1540                                         goto retry;
1541                                 }
1542                         }
1543
1544                         /* destroy our OTA image header */
1545                         spi_flash_erase_range(ota->address, 4096);
1546
1547                         /*
1548                          * with no viable OTA image, we will come back up in factory
1549                          * where the user can reload the OTA image
1550                          */
1551                         lwsl_notice("  FACTORY copy successful, rebooting\n");
1552 retry:
1553                         esp_restart();
1554                 }
1555 #endif
1556
1557         return part;
1558 }
1559
1560
1561 void
1562 lws_esp32_set_creation_defaults(struct lws_context_creation_info *info)
1563 {
1564         const esp_partition_t *part;
1565
1566         memset(info, 0, sizeof(*info));
1567
1568         lws_set_log_level(63, lwsl_emit_syslog);
1569
1570         part = lws_esp_ota_get_boot_partition();
1571         (void)part;
1572
1573         info->port = 443;
1574         info->fd_limit_per_thread = 30;
1575         info->max_http_header_pool = 3;
1576         info->max_http_header_data = 1024;
1577         info->pt_serv_buf_size = 4096;
1578         info->keepalive_timeout = 30;
1579         info->timeout_secs = 30;
1580         info->simultaneous_ssl_restriction = 3;
1581         info->options = LWS_SERVER_OPTION_EXPLICIT_VHOSTS |
1582                        LWS_SERVER_OPTION_DO_SSL_GLOBAL_INIT;
1583
1584         info->ssl_cert_filepath = "ssl-pub.pem";
1585         info->ssl_private_key_filepath = "ssl-pri.pem";
1586 }
1587
1588 int
1589 lws_esp32_get_image_info(const esp_partition_t *part, struct lws_esp32_image *i,
1590                          char *json, int json_len)
1591 {
1592         esp_image_segment_header_t eis;
1593         esp_image_header_t eih;
1594         uint32_t hdr;
1595
1596         spi_flash_read(part->address , &eih, sizeof(eih));
1597         hdr = part->address + sizeof(eih);
1598
1599         if (eih.magic != ESP_IMAGE_HEADER_MAGIC)
1600                 return 1;
1601
1602         eis.data_len = 0;
1603         while (eih.segment_count-- && eis.data_len != 0xffffffff) {
1604                 spi_flash_read(hdr, &eis, sizeof(eis));
1605                 hdr += sizeof(eis) + eis.data_len;
1606         }
1607         hdr += (~hdr & 15) + 1;
1608
1609         i->romfs = hdr + 4;
1610         spi_flash_read(hdr, &i->romfs_len, sizeof(i->romfs_len));
1611         i->json = i->romfs + i->romfs_len + 4;
1612         spi_flash_read(i->json - 4, &i->json_len, sizeof(i->json_len));
1613
1614         if (i->json_len < json_len - 1)
1615                 json_len = i->json_len;
1616         spi_flash_read(i->json, json, json_len);
1617         json[json_len] = '\0';
1618
1619         return 0;
1620 }
1621
1622 struct lws_context *
1623 lws_esp32_init(struct lws_context_creation_info *info)
1624 {
1625         const esp_partition_t *part = lws_esp_ota_get_boot_partition();
1626         struct lws_context *context;
1627         struct lws_esp32_image i;
1628         struct lws_vhost *vhost;
1629         nvs_handle nvh;
1630         char buf[512];
1631         size_t s;
1632         int n;
1633
1634         ESP_ERROR_CHECK(nvs_open("lws-station", NVS_READWRITE, &nvh));
1635         n = 0;
1636         s = 1;
1637         if (nvs_get_blob(nvh, "ssl-pub.pem", NULL, &s) == ESP_OK)
1638                 n = 1;
1639         s = 1;
1640         if (nvs_get_blob(nvh, "ssl-pri.pem", NULL, &s) == ESP_OK)
1641                 n |= 2;
1642         nvs_close(nvh);
1643
1644         if (n != 3) {
1645                 /* we are not configured for SSL yet... fall back to port 80 / http */
1646                 info->port = 80;
1647                 info->options &= ~LWS_SERVER_OPTION_DO_SSL_GLOBAL_INIT;
1648                 lwsl_notice("No SSL certs... using port 80\n");
1649         }
1650
1651         context = lws_create_context(info);
1652         if (context == NULL) {
1653                 lwsl_err("Failed to create context\n");
1654                 return NULL;
1655         }
1656
1657         lws_esp32_get_image_info(part, &i, buf, sizeof(buf) - 1);
1658         
1659         lws_esp32_romfs = (romfs_t)i.romfs;
1660         if (!romfs_mount_check(lws_esp32_romfs)) {
1661                 lwsl_err("Failed to mount ROMFS at %p 0x%x\n", lws_esp32_romfs, i.romfs);
1662                 return NULL;
1663         }
1664
1665         lwsl_notice("ROMFS length %uKiB\n", i.romfs_len >> 10);
1666
1667         puts(buf);
1668
1669         /* set the lws vfs to use our romfs */
1670
1671         lws_set_fops(context, &fops);
1672
1673         vhost = lws_create_vhost(context, info);
1674         if (!vhost)
1675                 lwsl_err("Failed to create vhost\n");
1676         else
1677                 lws_init_vhost_client_ssl(info, vhost); 
1678
1679         lws_protocol_init(context);
1680
1681         return context;
1682 }
1683
1684 static const uint16_t sineq16[] = {
1685         0x0000, 0x0191, 0x031e, 0x04a4, 0x061e, 0x0789, 0x08e2, 0x0a24,
1686         0x0b4e, 0x0c5c, 0x0d4b, 0x0e1a, 0x0ec6, 0x0f4d, 0x0faf, 0x0fea,
1687 };
1688
1689 static uint16_t sine_lu(int n)
1690 {
1691         switch ((n >> 4) & 3) {
1692         case 1:
1693                 return 4096 + sineq16[n & 15];
1694         case 2:
1695                 return 4096 + sineq16[15 - (n & 15)];
1696         case 3:
1697                 return 4096 - sineq16[n & 15];
1698         default:
1699                 return  4096 - sineq16[15 - (n & 15)];
1700         }
1701 }
1702
1703 /* useful for sine led fade patterns */
1704
1705 uint16_t lws_esp32_sine_interp(int n)
1706 {
1707         /*
1708          * 2: quadrant
1709          * 4: table entry in quadrant
1710          * 4: interp (LSB)
1711          *
1712          * total 10 bits / 1024 steps per cycle
1713          *
1714          * +   0: 0
1715          * + 256: 4096
1716          * + 512: 8192
1717          * + 768: 4096
1718          * +1023: 0
1719          */
1720
1721         return (sine_lu(n >> 4) * (15 - (n & 15)) +
1722                 sine_lu((n >> 4) + 1) * (n & 15)) / 15;
1723 }
1724