#include <ets_sys.h>
#include <osapi.h>
#include <os_type.h>
#include <c_types.h>
#include <ip_addr.h>
#include <espconn.h>
#include <user_interface.h>

#include "user_config.h"

#include "driver/uart_register.h"
#include "driver/uart.h"

//extern void ets_wdt_enable(void);
//extern void ets_wdt_disable(void);
//extern void wdt_feed(void);

static uint8_t cnt = 0;

static volatile ETSTimer mainloopTimer;
static void mainLoop(uint8_t mode);

#define sleepms(x) os_delay_us(x*1000);
#define MAINLOOPSLEEP  2500

void smartlink_promiscuous_rx(uint8_t*, uint16);
//====================================================
void ICACHE_FLASH_ATTR
smartlink_promiscuous_rx(uint8_t *buf, uint16 len) {

  if (len<64) return;
    
    
//----    
  {
    uint16_t i;
    uint16_t n=0;
    uint8_t ch;
      
    os_printf("  | SMARTLINK RX LEN[%d]\r\n", len);   
    os_printf("  | 00 01 02 03 04 05 06 07 08 09 0A 0B 0C 0D 0E 0F\r\n");
    os_printf("---------------------------------------------------");
    for (i=0; i<len; i++) {
      if (i==n) {
        os_printf("\r\n%02x| ",n);
        n+=16;
      }          
#if 1
      ch = buf[i];
      if (isprint(ch))
        os_printf(" %c ", ch);
      else
        os_printf("%02x ", ch);
#else    
      os_printf("%02x ", buf[i]);
#endif
    }
    os_printf("\r\n---------------------------------------------------\r\n");
  } 

}

//Main code function
static void ICACHE_FLASH_ATTR
mainLoop(uint8_t mode) {

  os_timer_disarm(&mainloopTimer);

  os_printf("-%s-%s MAINLOOP\n\r", __FILE__, __func__);
  
  if (cnt==1) {
    os_printf("-%s-%s SMARTLINK PROMISCUOUS ENABLE\r\n", __FILE__, __func__);     
    wifi_promiscuous_enable(1);
    wifi_set_promiscuous_rx_cb(smartlink_promiscuous_rx);   
  }
  
  cnt++;

  os_timer_setfn(&mainloopTimer, mainLoop, 0);
  os_timer_arm(&mainloopTimer, MAINLOOPSLEEP, 0);
}

//Init function 
void user_init(void)
{

  uart_init(BIT_RATE_115200, BIT_RATE_115200);
  
  {
    os_printf("\r\n=======================\r\n");
    os_printf("***System Info\r\n");
    os_printf("***Time=%ld\r\n", system_get_time());
    os_printf("***Chip id=%ld\r\n", system_get_chip_id());
    os_printf("***Free heap size=%ld\r\n", system_get_free_heap_size());
    os_printf("***Mem info:\r\n");
    system_print_meminfo();
    os_printf("=======================\r\n");
  }  
  
  if (wifi_get_opmode() != STATION_MODE) { 
    os_printf("-%s-%s WIFI SET MODE TO STA\r\n", __FILE__, __func__);
    ETS_UART_INTR_DISABLE();      
    wifi_set_opmode(STATION_MODE);
    ETS_UART_INTR_ENABLE();
    os_delay_us(500);
  }

  os_timer_disarm(&mainloopTimer);
  os_timer_setfn(&mainloopTimer, mainLoop, 0);
  os_timer_arm(&mainloopTimer, 100, 0);

}