diff --git a/mesh/node.c b/mesh/node.c
index af45a61..4e9b80b 100644
--- a/mesh/node.c
+++ b/mesh/node.c
netkey->phase);
}
-static void set_app_key(void *a, void *b)
+static void set_appkey(void *a, void *b)
{
struct mesh_config_appkey *appkey = a;
struct mesh_node *node = b;
l_queue_foreach(db_node->netkeys, set_net_key, node);
if (db_node->appkeys)
- l_queue_foreach(db_node->appkeys, set_app_key, node);
+ l_queue_foreach(db_node->appkeys, set_appkey, node);
mesh_net_set_seq_num(node->net, node->seq_number);
mesh_net_set_default_ttl(node->net, node->ttl);
return l_dbus_message_new_method_return(msg);
}
+static struct l_dbus_message *add_netkey_call(struct l_dbus *dbus,
+ struct l_dbus_message *msg,
+ void *user_data)
+{
+ struct mesh_node *node = user_data;
+ const char *sender, *ele_path;
+ struct node_element *ele;
+ uint16_t dst, sub_idx, net_idx, src;
+ bool update;
+ struct keyring_net_key key;
+ uint8_t data[20];
+
+ l_debug("AddNetKey");
+
+ sender = l_dbus_message_get_sender(msg);
+
+ if (strcmp(sender, node->owner))
+ return dbus_error(msg, MESH_ERROR_NOT_AUTHORIZED, NULL);
+
+ if (!l_dbus_message_get_arguments(msg, "oqqqb", &ele_path, &dst,
+ &sub_idx, &net_idx, &update))
+ return dbus_error(msg, MESH_ERROR_INVALID_ARGS, NULL);
+
+ ele = l_queue_find(node->elements, match_element_path, ele_path);
+ if (!ele)
+ return dbus_error(msg, MESH_ERROR_NOT_FOUND,
+ "Element not found");
+
+ src = node_get_primary(node) + ele->idx;
+
+ if (!keyring_get_net_key(node, sub_idx, &key))
+ return dbus_error(msg, MESH_ERROR_NOT_FOUND,
+ "NetKey not found");
+
+ if (!update) {
+ l_put_be16(OP_NETKEY_ADD, data);
+
+ if (key.phase != KEY_REFRESH_PHASE_TWO)
+ memcpy(data + 4, key.old_key, 16);
+ else
+ memcpy(data + 4, key.new_key, 16);
+ } else {
+ if (key.phase != KEY_REFRESH_PHASE_ONE)
+ return dbus_error(msg, MESH_ERROR_FAILED,
+ "Cannot update");
+ l_put_be16(OP_NETKEY_UPDATE, data);
+ memcpy(data + 4, key.new_key, 16);
+ }
+
+ l_put_le16(sub_idx, &data[2]);
+
+ if (!mesh_model_send(node, src, dst, APP_IDX_DEV_REMOTE, net_idx,
+ DEFAULT_TTL, data, 20))
+ return dbus_error(msg, MESH_ERROR_NOT_FOUND, NULL);
+
+ return l_dbus_message_new_method_return(msg);
+}
+
+static struct l_dbus_message *add_appkey_call(struct l_dbus *dbus,
+ struct l_dbus_message *msg,
+ void *user_data)
+{
+ struct mesh_node *node = user_data;
+ const char *sender, *ele_path;
+ struct node_element *ele;
+ uint16_t dst, app_idx, net_idx, src;
+ bool update;
+ struct keyring_net_key net_key;
+ struct keyring_app_key app_key;
+ uint8_t data[20];
+
+ l_debug("AddAppKey");
+
+ sender = l_dbus_message_get_sender(msg);
+
+ if (strcmp(sender, node->owner))
+ return dbus_error(msg, MESH_ERROR_NOT_AUTHORIZED, NULL);
+
+ if (!l_dbus_message_get_arguments(msg, "oqqqb", &ele_path, &dst,
+ &app_idx, &net_idx, &update))
+ return dbus_error(msg, MESH_ERROR_INVALID_ARGS, NULL);
+
+ ele = l_queue_find(node->elements, match_element_path, ele_path);
+ if (!ele)
+ return dbus_error(msg, MESH_ERROR_NOT_FOUND,
+ "Element not found");
+
+ src = node_get_primary(node) + ele->idx;
+
+ if (!keyring_get_app_key(node, app_idx, &app_key))
+ return dbus_error(msg, MESH_ERROR_NOT_FOUND,
+ "AppKey not found");
+
+ if (!keyring_get_net_key(node, app_key.net_idx, &net_key)) {
+ return dbus_error(msg, MESH_ERROR_NOT_FOUND,
+ "Bound NetKey not found");
+ }
+
+ if (!update) {
+ data[0] = OP_APPKEY_ADD;
+ if (net_key.phase != KEY_REFRESH_PHASE_TWO)
+ memcpy(data + 4, app_key.old_key, 16);
+ else
+ memcpy(data + 4, app_key.new_key, 16);
+ } else {
+ if (net_key.phase != KEY_REFRESH_PHASE_ONE)
+ return dbus_error(msg, MESH_ERROR_FAILED,
+ "Cannot update");
+ data[0] = OP_APPKEY_UPDATE;
+ memcpy(data + 4, app_key.new_key, 16);
+ }
+
+ /* Pack bound NetKey and AppKey into 3 octets */
+ data[1] = app_key.net_idx;
+ data[2] = ((app_key.net_idx >> 8) & 0xf) | ((app_idx << 4) & 0xf0);
+ data[3] = app_idx >> 4;
+
+ if (!mesh_model_send(node, src, dst, APP_IDX_DEV_REMOTE, net_idx,
+ DEFAULT_TTL, data, 20))
+ return dbus_error(msg, MESH_ERROR_NOT_FOUND, NULL);
+
+ return l_dbus_message_new_method_return(msg);
+}
+
static struct l_dbus_message *publish_call(struct l_dbus *dbus,
struct l_dbus_message *msg,
void *user_data)
"", "oqbqay", "element_path",
"destination", "remote",
"net_index", "data");
+ l_dbus_interface_method(iface, "AddNetKey", 0, add_netkey_call, "",
+ "oqqqb", "element_path", "destination",
+ "subnet_index", "net_index", "update");
+ l_dbus_interface_method(iface, "AddAppKey", 0, add_appkey_call, "",
+ "oqqqb", "element_path", "destination",
+ "app_index", "net_index", "update");
l_dbus_interface_method(iface, "Publish", 0, publish_call, "", "oqay",
"element_path", "model_id", "data");
l_dbus_interface_method(iface, "VendorPublish", 0, vendor_publish_call,