forked from kofal.net/zmk
More sensor keymap work.
This commit is contained in:
@@ -137,7 +137,7 @@ int zmk_keymap_position_state_changed(u32_t position, bool pressed)
|
||||
struct device *behavior;
|
||||
int ret;
|
||||
|
||||
LOG_DBG("layer: %d position: %d, binding name: %s", layer, position, binding->behavior_dev);
|
||||
LOG_DBG("layer: %d position: %d, binding name: %s", layer, position, log_strdup(binding->behavior_dev));
|
||||
|
||||
behavior = device_get_binding(binding->behavior_dev);
|
||||
|
||||
@@ -167,17 +167,53 @@ int zmk_keymap_position_state_changed(u32_t position, bool pressed)
|
||||
return -ENOTSUP;
|
||||
}
|
||||
|
||||
int zmk_keymap_sensor_triggered(u8_t sensor_number, struct device *sensor)
|
||||
{
|
||||
for (int layer = ZMK_KEYMAP_LAYERS_LEN - 1; layer >= zmk_keymap_layer_default; layer--)
|
||||
{
|
||||
if (((zmk_keymap_layer_state & BIT(layer)) == BIT(layer) || layer == zmk_keymap_layer_default) && zmk_sensor_keymap[layer] != NULL)
|
||||
{
|
||||
struct zmk_behavior_binding *binding = &zmk_sensor_keymap[layer][sensor_number];
|
||||
struct device *behavior;
|
||||
int ret;
|
||||
|
||||
LOG_DBG("layer: %d sensor_number: %d, binding name: %s", layer, sensor_number, log_strdup(binding->behavior_dev));
|
||||
|
||||
behavior = device_get_binding(binding->behavior_dev);
|
||||
|
||||
if (!behavior) {
|
||||
LOG_DBG("No behavior assigned to %d on layer %d", sensor_number, layer);
|
||||
continue;
|
||||
}
|
||||
|
||||
ret = behavior_sensor_keymap_binding_triggered(behavior, sensor, binding->param1, binding->param2);
|
||||
|
||||
if (ret > 0) {
|
||||
LOG_DBG("behavior processing to continue to next layer");
|
||||
continue;
|
||||
} else if (ret < 0) {
|
||||
LOG_DBG("Behavior returned error: %d", ret);
|
||||
return ret;
|
||||
} else {
|
||||
return ret;
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
return -ENOTSUP;
|
||||
}
|
||||
|
||||
int keymap_listener(const struct zmk_event_header *eh)
|
||||
{
|
||||
if (is_position_state_changed(eh)) {
|
||||
const struct position_state_changed *ev = cast_position_state_changed(eh);
|
||||
zmk_keymap_position_state_changed(ev->position, ev->state);
|
||||
return zmk_keymap_position_state_changed(ev->position, ev->state);
|
||||
} else if (is_sensor_event(eh)) {
|
||||
const struct sensor_event *ev = cast_sensor_event(eh);
|
||||
// TODO: DO SOMETHING WITH IT!
|
||||
return zmk_keymap_sensor_triggered(ev->sensor_number, ev->sensor);
|
||||
}
|
||||
|
||||
return 0;
|
||||
return -ENOTSUP;
|
||||
}
|
||||
|
||||
ZMK_LISTENER(keymap, keymap_listener);
|
||||
|
||||
@@ -23,7 +23,7 @@ struct sensors_data_item {
|
||||
};
|
||||
|
||||
#define _SENSOR_ITEM(node) {.dev = NULL, .trigger = { .type = SENSOR_TRIG_DELTA, .chan = SENSOR_CHAN_ROTATION } },
|
||||
#define SENSOR_ITEM(node, _) COND_CODE_1(DT_NODE_HAS_STATUS(node,okay), (_SENSOR_ITEM(node)),())
|
||||
#define SENSOR_ITEM(idx, _) COND_CODE_1(DT_NODE_HAS_STATUS(ZMK_KEYMAP_SENSORS_BY_IDX(idx),okay), (_SENSOR_ITEM(ZMK_KEYMAP_SENSORS_BY_IDX(idx))),())
|
||||
|
||||
static struct sensors_data_item sensors[] = {
|
||||
UTIL_LISTIFY(ZMK_KEYMAP_SENSORS_LEN, SENSOR_ITEM, 0)
|
||||
@@ -32,7 +32,6 @@ static struct sensors_data_item sensors[] = {
|
||||
static void zmk_sensors_trigger_handler(struct device *dev, struct sensor_trigger *trigger)
|
||||
{
|
||||
int err;
|
||||
struct sensor_value val;
|
||||
struct sensors_data_item * item = CONTAINER_OF(trigger, struct sensors_data_item, trigger);
|
||||
struct sensor_event *event;
|
||||
|
||||
@@ -46,14 +45,7 @@ static void zmk_sensors_trigger_handler(struct device *dev, struct sensor_trigge
|
||||
|
||||
event = new_sensor_event();
|
||||
event->sensor_number = item->sensor_number;
|
||||
|
||||
err = sensor_channel_get(dev, SENSOR_CHAN_ROTATION, &event->value);
|
||||
if (err) {
|
||||
k_free(event);
|
||||
LOG_WRN("Failed to get the value for the rotation channel: %d", err);
|
||||
}
|
||||
|
||||
LOG_DBG("val1 %d val2 %d", val.val1, val.val2);
|
||||
event->sensor = dev;
|
||||
|
||||
ZMK_EVENT_RAISE(event);
|
||||
}
|
||||
@@ -73,7 +65,7 @@ static void zmk_sensors_init_item(const char *node, u8_t i, u8_t abs_i)
|
||||
}
|
||||
|
||||
#define _SENSOR_INIT(node) zmk_sensors_init_item(DT_LABEL(node), local_index++, absolute_index++);
|
||||
#define SENSOR_INIT(node, _i) COND_CODE_1(DT_NODE_HAS_STATUS(node,okay), (_SENSOR_INIT(node)),(absolute_index++;))
|
||||
#define SENSOR_INIT(idx, _i) COND_CODE_1(DT_NODE_HAS_STATUS(ZMK_KEYMAP_SENSORS_BY_IDX(idx),okay), (_SENSOR_INIT(ZMK_KEYMAP_SENSORS_BY_IDX(idx))),(absolute_index++;))
|
||||
|
||||
static int zmk_sensors_init(struct device *_arg)
|
||||
{
|
||||
|
||||
Reference in New Issue
Block a user