#include <stdio.h>
#include <stdlib.h>
#include <stdint.h>

#include "cbor.h"
#include "usbhid.h"
#include "ctaphid.h"
#include "util.h"


void check_ret(CborError ret)
{
    if (ret != CborNoError)
    {
        printf("CborError: %d\n", ret);
        exit(1);
    }
}


int main(int argc, char * argv[])
{
    /*CborError ret;*/
    /*uint8_t buf[16];*/
    /*memset(buf,0,sizeof(buf));*/
    /*CborEncoder encoder;*/
    /*cbor_encoder_init(&encoder, buf, sizeof(buf), 0);*/
    /*ret = cbor_encode_int(&encoder, 55);*/
    /*check_ret(ret);*/

    /*dump_hex(buf,sizeof(buf));*/

    printf("init usbhid\n");
    usbhid_init();
    printf("init ctaphid\n");
    ctaphid_init();

    int count = 0;
    uint8_t hidmsg[64];
    CTAPHID_STATUS res;
    memset(hidmsg,0,sizeof(hidmsg));

    printf("recv'ing hid msg \n");

    while(1)
    {
        usbhid_recv(hidmsg);
        printf("%d>> ",count++); dump_hex(hidmsg,sizeof(hidmsg));

        ctaphid_handle_packet(hidmsg, &res);
        memset(hidmsg, 0, sizeof(hidmsg));
        ctaphid_dump_status(&res);

        int i;
        for(i = 0; i < res.length; i += 64)
        {
            memmove(hidmsg, res.data + i, MIN(res.length - i, 64));
            usbhid_send(hidmsg);
            printf("<< "); dump_hex(hidmsg,sizeof(hidmsg));
        }
        printf("\n");
    }


    usbhid_close();
    printf("done\n");
    return 0;
}