2016-10-11 12:05:55 +00:00
|
|
|
/*
|
|
|
|
* Copyright (c) Pavol Rusnak, SatoshiLabs
|
|
|
|
*
|
|
|
|
* Licensed under TREZOR License
|
|
|
|
* see LICENSE file for details
|
|
|
|
*/
|
|
|
|
|
2016-04-29 01:15:18 +00:00
|
|
|
#include <arpa/inet.h>
|
|
|
|
#include <sys/socket.h>
|
2016-04-29 13:05:08 +00:00
|
|
|
#include <fcntl.h>
|
2016-04-29 01:15:18 +00:00
|
|
|
#include <assert.h>
|
2016-05-05 23:57:29 +00:00
|
|
|
#include <stdlib.h>
|
2016-04-29 01:15:18 +00:00
|
|
|
|
2017-04-21 16:12:33 +00:00
|
|
|
#include "unix-usb-mock.h"
|
|
|
|
|
2016-05-05 23:57:29 +00:00
|
|
|
#define TREZOR_UDP_PORT 21324
|
2016-04-29 01:15:18 +00:00
|
|
|
|
|
|
|
static int s;
|
|
|
|
static struct sockaddr_in si_me, si_other;
|
|
|
|
static socklen_t slen = 0;
|
|
|
|
|
|
|
|
void msg_init(void)
|
|
|
|
{
|
2016-04-29 13:05:08 +00:00
|
|
|
s = socket(AF_INET, SOCK_DGRAM, IPPROTO_UDP);
|
2016-04-29 01:15:18 +00:00
|
|
|
assert(s != -1);
|
|
|
|
|
2016-04-29 13:05:08 +00:00
|
|
|
fcntl(s, F_SETFL, O_NONBLOCK);
|
|
|
|
|
2016-04-29 01:15:18 +00:00
|
|
|
si_me.sin_family = AF_INET;
|
2016-05-05 23:57:29 +00:00
|
|
|
const char *ip = getenv("TREZOR_UDP_IP");
|
|
|
|
if (ip) {
|
|
|
|
si_me.sin_addr.s_addr = inet_addr(ip);
|
|
|
|
} else {
|
|
|
|
si_me.sin_addr.s_addr = htonl(INADDR_LOOPBACK);
|
|
|
|
}
|
|
|
|
const char *port = getenv("TREZOR_UDP_PORT");
|
|
|
|
if (port) {
|
|
|
|
si_me.sin_port = htons(atoi(port));
|
|
|
|
} else {
|
|
|
|
si_me.sin_port = htons(TREZOR_UDP_PORT);
|
|
|
|
}
|
2016-04-29 01:15:18 +00:00
|
|
|
|
|
|
|
int b;
|
|
|
|
b = bind(s, (struct sockaddr*)&si_me, sizeof(si_me));
|
|
|
|
assert(b != -1);
|
|
|
|
}
|
|
|
|
|
2016-10-11 11:13:14 +00:00
|
|
|
ssize_t msg_recv(uint8_t *iface, uint8_t *buf, size_t len)
|
2016-04-29 01:15:18 +00:00
|
|
|
{
|
|
|
|
struct sockaddr_in si;
|
2016-05-18 17:27:42 +00:00
|
|
|
socklen_t sl = sizeof(si);
|
2016-05-23 15:53:42 +00:00
|
|
|
memset(buf, 0, len);
|
2016-10-11 11:13:14 +00:00
|
|
|
*iface = 0; // TODO: return proper interface
|
2016-05-30 14:29:06 +00:00
|
|
|
ssize_t r = recvfrom(s, buf, len, MSG_DONTWAIT, (struct sockaddr *)&si, &sl);
|
2016-05-23 15:53:42 +00:00
|
|
|
if (r < 0) {
|
|
|
|
return r;
|
2016-04-29 01:15:18 +00:00
|
|
|
}
|
|
|
|
si_other = si;
|
|
|
|
slen = sl;
|
2016-05-23 15:53:42 +00:00
|
|
|
return r;
|
2016-04-29 01:15:18 +00:00
|
|
|
}
|
|
|
|
|
2016-10-11 11:13:14 +00:00
|
|
|
ssize_t msg_send(uint8_t iface, const uint8_t *buf, size_t len)
|
2016-04-29 01:15:18 +00:00
|
|
|
{
|
2016-10-11 11:13:14 +00:00
|
|
|
(void)iface; // TODO: ignore interface for now
|
2016-10-04 16:53:32 +00:00
|
|
|
ssize_t r = len;
|
|
|
|
if (slen > 0) {
|
2016-04-29 01:15:18 +00:00
|
|
|
r = sendto(s, buf, len, MSG_DONTWAIT, (const struct sockaddr *)&si_other, slen);
|
|
|
|
}
|
|
|
|
return r;
|
|
|
|
}
|