/*
 * 7-1 UDP サーバ
 *
 *  OS: T-Kernel
 *
 */

#include <tk/tkernel.h>  /* T-Kernel ヘッダ */
#include <tm/tmonitor.h> /* tm_printf() など */
#include <libstr.h>      /* memcpy() など */
#include <utkn/utkn.h>   /* 6LoWPAN */

/* オブジェクト ID 番号 */
LOCAL ID tidA;           /* タスク A の ID */

/* タスク A */
LOCAL void taskA(INT stacd, void *exinf)
{
    static const utkn_6ln_init_t param = {
        .channel = RF_CHANNEL_ANY,
        .scan_type = WPAN_SCAN_ACTIVE,
        .scan_duration = 4,
        .options = 0,
        .tmout = TMO_FEVR,
    };
    static udp6_cep_t dst;
    static udp6_cep_t cep;
    ID cepid;
    INT len;
    static UB buf[16];

    /* 6LoWPAN プロトコルスタックを初期化する */
    utkn_6ln_init(&param);

    /* UDP 通信端点をオープンする */
    cep.addr = ip6_addr_unspec;
    cep.port = htons(9000); /* UDP サーバのポート番号 */
    cepid = udp6_open(&cep);

    tm_printf((UB*)"UDP Server Started.\n"); 

    for (;;) {
        /* UDP 受信する */
        len = udp6_recv(cepid, buf, sizeof(buf), &dst, NULL, NULL, TMO_FEVR);
        if (len < 0) continue;
        tm_printf((UB*)"%.*s\n", len, buf);

        /* UDP 送信する */
        len = 14;
        memcpy(buf, "ok from NodeXX", len);
        udp6_send(cepid, buf, len, &dst, 5000);
    }

    /* このタスクは終了しない */
}

/* 初期化処理 */
EXPORT INT usermain(void)
{
    T_CTSK ct;

    /* タスク A を生成する */
    ct.exinf = (void*)('t' | 's' << 8 | 'k' << 16 | 'A' << 24); /* 拡張情報 */
    ct.tskatr = TA_HLNG | TA_RNG0;  /* タスク属性 */
    ct.task = taskA;                /* タスク起動アドレス */
    ct.itskpri = 1;                 /* タスク起動時優先度 */
    ct.stksz = 1024;                /* スタックサイズ */
    tidA = tk_cre_tsk(&ct);         /* タスク A を生成 */
    if (tidA < E_OK) return tidA;   /* タスク生成失敗時 */

    tk_sta_tsk(tidA, 0);            /* タスク A を起動 */

    return E_OK;
}