void dterm_kv_string(dterm_t* t,ErlDrvTermData key, char* value)
{
dterm_mark_t m;
size_t len = strlen(value);
char* dst = (char*) dterm_link_copy_data(t, value, len);
dterm_tuple_begin(t, &m); {
dterm_atom(t, key);
dterm_string(t, dst, len);
}
dterm_tuple_end(t, &m);
}
static unsigned char send_device_info(IEContext* ctx, unsigned int reply_id)
{
dterm_mark_t msg;
dterm_t dt;
int len = 0;
char name[256];
char topology[256];
char uniq_id[256];
struct input_id id;
// Get device id.
if (ioctl(ctx->mDescriptor, EVIOCGID, &id) < 0)
{
return IEDRV_RES_IO_ERROR;
}
if ((len = ioctl(ctx->mDescriptor, EVIOCGNAME(sizeof(name) - 1), name)) < 0) {
return IEDRV_RES_IO_ERROR;
}
name[len] = 0;
if ((len = ioctl(ctx->mDescriptor, EVIOCGPHYS(sizeof(topology) - 1), topology)) < 0) {
return IEDRV_RES_IO_ERROR;
}
topology[len] = 0;
if ((len = ioctl(ctx->mDescriptor, EVIOCGUNIQ(sizeof(uniq_id) - 1), uniq_id)) < 0)
uniq_id[0] = 0;
uniq_id[len] = 0;
dterm_init(&dt);
dterm_tuple_begin(&dt, &msg); {
dterm_mark_t prop;
dterm_atom(&dt, ie_device_info);
dterm_port(&dt, ctx->mDport);
dterm_int(&dt, reply_id);
//
// Setup { id, Bustype, Vendor, Product, Version, Name}
//
dterm_tuple_begin(&dt, &prop); {
dterm_atom(&dt, ie_drv_dev_id);
dterm_string(&dt, uniq_id, strlen(uniq_id));
dterm_string(&dt, name, strlen(name));
dterm_atom(&dt, *bus_atoms[id.bustype]);
dterm_int(&dt, id.vendor);
dterm_int(&dt, id.product);
dterm_int(&dt, id.version);
dterm_string(&dt, topology, strlen(topology));
//
// Setup [{ capability, [ { Cap, [X] }, { Cap, [Y] }, ...}, ...]
//
add_cap(&dt, ctx->mDescriptor);
dterm_tuple_end(&dt, &prop);
}
}
dterm_tuple_end(&dt, &msg);
driver_output_term(ctx->mPort, dterm_data(&dt), dterm_used_size(&dt));
dterm_finish(&dt);
return IEDRV_RES_OK;
}
