77 lines
1.5 KiB
C
77 lines
1.5 KiB
C
#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);
|
|
}
|
|
}
|
|
|
|
|
|
void ctaphid_write_block(uint8_t * data)
|
|
{
|
|
printf("usbhid send\n");
|
|
dump_hex(data, 64);
|
|
usbhid_send(data);
|
|
}
|
|
|
|
|
|
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;
|
|
}
|