modtrezormsg: use usage_page to identify interfaces

pull/25/head
Pavol Rusnak 8 years ago
parent d9546d45b9
commit 3f44dfedb5
No known key found for this signature in database
GPG Key ID: 91F3B339B9A02A3D

@ -20,15 +20,15 @@ void msg_init(void)
i2c_init(&I2CHandle1); i2c_init(&I2CHandle1);
} }
ssize_t msg_recv(uint8_t *iface, uint8_t *buf, size_t len) ssize_t msg_recv(uint16_t *usage_page, uint8_t *buf, size_t len)
{ {
*iface = 0; // use always interface 0 for now *usage_page = 0xFF00; // TODO: return proper usage page
return USBD_HID_Rx(buf, len, 1); return USBD_HID_Rx(buf, len, 1);
} }
ssize_t msg_send(uint8_t iface, const uint8_t *buf, size_t len) ssize_t msg_send(uint16_t usage_page, const uint8_t *buf, size_t len)
{ {
(void)iface; // ignore interface for now (void)usage_page; // TODO: ignore usage page for now
if (len > 0) { if (len > 0) {
USBD_HID_SendReport(&hUSBDDevice, (uint8_t *)buf, len); USBD_HID_SendReport(&hUSBDDevice, (uint8_t *)buf, len);
} }

@ -36,12 +36,12 @@ void msg_init(void)
assert(b != -1); assert(b != -1);
} }
ssize_t msg_recv(uint8_t *iface, uint8_t *buf, size_t len) ssize_t msg_recv(uint16_t *usage_page, uint8_t *buf, size_t len)
{ {
struct sockaddr_in si; struct sockaddr_in si;
socklen_t sl = sizeof(si); socklen_t sl = sizeof(si);
memset(buf, 0, len); memset(buf, 0, len);
*iface = 0; // UDP uses always interface 0 *usage_page = 0xFF00; // TODO: return proper usage page
ssize_t r = recvfrom(s, buf, len, MSG_DONTWAIT, (struct sockaddr *)&si, &sl); ssize_t r = recvfrom(s, buf, len, MSG_DONTWAIT, (struct sockaddr *)&si, &sl);
if (r < 0) { if (r < 0) {
return r; return r;
@ -51,9 +51,9 @@ ssize_t msg_recv(uint8_t *iface, uint8_t *buf, size_t len)
return r; return r;
} }
ssize_t msg_send(uint8_t iface, const uint8_t *buf, size_t len) ssize_t msg_send(uint16_t usage_page, const uint8_t *buf, size_t len)
{ {
(void)iface; // ignore interface for UDP (void)usage_page; // TODO: ignore usage page for now
ssize_t r = len; ssize_t r = len;
if (slen > 0) { if (slen > 0) {
r = sendto(s, buf, len, MSG_DONTWAIT, (const struct sockaddr *)&si_other, slen); r = sendto(s, buf, len, MSG_DONTWAIT, (const struct sockaddr *)&si_other, slen);

@ -39,50 +39,42 @@ STATIC mp_obj_t mod_TrezorMsg_Msg_make_new(const mp_obj_type_t *type, size_t n_a
/// def trezor.msg.setup(ifaces: list) -> None: /// def trezor.msg.setup(ifaces: list) -> None:
/// ''' /// '''
/// Configures USB interfaces with a list of tuples (interface_number, usage_page) /// Configures USB interfaces with a list of (usage_page, ...)
/// ''' /// '''
STATIC mp_obj_t mod_TrezorMsg_Msg_setup(mp_obj_t self, mp_obj_t ifaces) { STATIC mp_obj_t mod_TrezorMsg_Msg_setup(mp_obj_t self, mp_obj_t ifaces) {
mp_uint_t iface_cnt; mp_uint_t iface_cnt;
mp_obj_t *iface; mp_obj_t *usage_pages;
if (MP_OBJ_IS_TYPE(ifaces, &mp_type_tuple)) { if (MP_OBJ_IS_TYPE(ifaces, &mp_type_tuple)) {
mp_obj_tuple_get(ifaces, &iface_cnt, &iface); mp_obj_tuple_get(ifaces, &iface_cnt, &usage_pages);
} else } else
if (MP_OBJ_IS_TYPE(ifaces, &mp_type_list)) { if (MP_OBJ_IS_TYPE(ifaces, &mp_type_list)) {
mp_obj_list_get(ifaces, &iface_cnt, &iface); mp_obj_list_get(ifaces, &iface_cnt, &usage_pages);
} else { } else {
mp_raise_TypeError("List or tuple expected"); mp_raise_TypeError("List or tuple expected");
} }
for (mp_uint_t i = 0; i < iface_cnt; i++) { for (mp_uint_t i = 0; i < iface_cnt; i++) {
if (!MP_OBJ_IS_TYPE(iface[i], &mp_type_tuple)) { uint16_t usage_page = mp_obj_get_int(usage_pages[i]);
mp_raise_TypeError("Tuple expected"); printf("iface %d: usage_page=%04x\n", i + 1, usage_page);
}
mp_uint_t attr_cnt;
mp_obj_t *attr;
mp_obj_tuple_get(iface[i], &attr_cnt, &attr);
assert(attr_cnt == 2);
uint8_t endpoint = mp_obj_get_int(attr[0]);
uint16_t usage_page = mp_obj_get_int(attr[1]);
printf("iface %d: ep=%d up=%04x\n", (uint16_t)i, endpoint, usage_page);
} }
return mp_const_none; return mp_const_none;
} }
STATIC MP_DEFINE_CONST_FUN_OBJ_2(mod_TrezorMsg_Msg_setup_obj, mod_TrezorMsg_Msg_setup); STATIC MP_DEFINE_CONST_FUN_OBJ_2(mod_TrezorMsg_Msg_setup_obj, mod_TrezorMsg_Msg_setup);
/// def trezor.msg.send(iface: int, message: bytes) -> int: /// def trezor.msg.send(usage_page: int, message: bytes) -> int:
/// ''' /// '''
/// Sends message using USB HID (device) or UDP (emulator). /// Sends message using USB HID (device) or UDP (emulator).
/// ''' /// '''
STATIC mp_obj_t mod_TrezorMsg_Msg_send(mp_obj_t self, mp_obj_t iface, mp_obj_t message) { STATIC mp_obj_t mod_TrezorMsg_Msg_send(mp_obj_t self, mp_obj_t usage_page, mp_obj_t message) {
uint8_t iface_num = mp_obj_get_int(iface); uint16_t up = mp_obj_get_int(usage_page);
mp_buffer_info_t msg; mp_buffer_info_t msg;
mp_get_buffer_raise(message, &msg, MP_BUFFER_READ); mp_get_buffer_raise(message, &msg, MP_BUFFER_READ);
ssize_t r = msg_send(iface_num, msg.buf, msg.len); ssize_t r = msg_send(up, msg.buf, msg.len);
return MP_OBJ_NEW_SMALL_INT(r); return MP_OBJ_NEW_SMALL_INT(r);
} }
STATIC MP_DEFINE_CONST_FUN_OBJ_3(mod_TrezorMsg_Msg_send_obj, mod_TrezorMsg_Msg_send); STATIC MP_DEFINE_CONST_FUN_OBJ_3(mod_TrezorMsg_Msg_send_obj, mod_TrezorMsg_Msg_send);
#define TICK_RESOLUTION 1000 #define TICK_RESOLUTION 1000
#define TOUCH_IFACE 256 #define TOUCH_IFACE 0
/// def trezor.msg.select(timeout_us: int) -> tuple: /// def trezor.msg.select(timeout_us: int) -> tuple:
/// ''' /// '''
@ -104,12 +96,12 @@ STATIC mp_obj_t mod_TrezorMsg_Msg_select(mp_obj_t self, mp_obj_t timeout_us) {
tuple->items[3] = MP_OBJ_NEW_SMALL_INT((e & 0xFF)); // y position tuple->items[3] = MP_OBJ_NEW_SMALL_INT((e & 0xFF)); // y position
return MP_OBJ_FROM_PTR(tuple); return MP_OBJ_FROM_PTR(tuple);
} }
uint8_t iface; uint16_t iface_usage_page;
uint8_t recvbuf[64]; uint8_t recvbuf[64];
ssize_t l = msg_recv(&iface, recvbuf, 64); ssize_t l = msg_recv(&iface_usage_page, recvbuf, 64);
if (l > 0) { if (l > 0) {
mp_obj_tuple_t *tuple = MP_OBJ_TO_PTR(mp_obj_new_tuple(2, NULL)); mp_obj_tuple_t *tuple = MP_OBJ_TO_PTR(mp_obj_new_tuple(2, NULL));
tuple->items[0] = MP_OBJ_NEW_SMALL_INT(iface); tuple->items[0] = MP_OBJ_NEW_SMALL_INT(iface_usage_page);
tuple->items[1] = mp_obj_new_str_of_type(&mp_type_bytes, recvbuf, l); tuple->items[1] = mp_obj_new_str_of_type(&mp_type_bytes, recvbuf, l);
return MP_OBJ_FROM_PTR(tuple); return MP_OBJ_FROM_PTR(tuple);
} }

@ -17,7 +17,7 @@ wallet.boot()
ui.display.backlight(ui.BACKLIGHT_NORMAL) ui.display.backlight(ui.BACKLIGHT_NORMAL)
# Just a demo to show how to register USB ifaces # Just a demo to show how to register USB ifaces
msg.setup([(1, 0xF53C), (2, 0xF1D0)]) msg.setup([0xFF00, 0xFF01, 0xF1D0])
# Initialize the wire codec pipeline # Initialize the wire codec pipeline
wire.setup() wire.setup()

@ -17,10 +17,10 @@ scheduled_tasks = [] # heap: [(time, counter, task, value)]
MAX_SELECT_DELAY = const(1000000) MAX_SELECT_DELAY = const(1000000)
# message interfaces: # message interfaces:
# 0-255 - USB HID # 0x0000 - touch event interface
# 256 - touch event interface # 0x0001 - 0xFFFF - USB HID
TOUCH = const(256) # interface TOUCH = const(0) # interface
TOUCH_START = const(1) # event TOUCH_START = const(1) # event
TOUCH_MOVE = const(2) # event TOUCH_MOVE = const(2) # event
TOUCH_END = const(4) # event TOUCH_END = const(4) # event

@ -2,7 +2,7 @@ import ubinascii
from micropython import const from micropython import const
from trezor import msg, loop, log from trezor import msg, loop, log
_DEFAULT_IFACE = const(0) _DEFAULT_IFACE = const(0xFF00)
def read_report_stream(target, iface=_DEFAULT_IFACE): def read_report_stream(target, iface=_DEFAULT_IFACE):

Loading…
Cancel
Save