9 #include <sys/socket.h>
11 #include <asm/byteorder.h>
13 #include <talloc/talloc.h>
16 #include "discover-client.h"
17 #include "pb-protocol/pb-protocol.h"
19 struct discover_client {
21 struct discover_client_ops ops;
23 struct device **devices;
26 static int discover_client_destructor(void *arg)
28 struct discover_client *client = arg;
36 void discover_client_destroy(struct discover_client *client)
41 static struct device *find_device(struct discover_client *client,
46 for (i = 0; i < client->n_devices; i++) {
47 struct device *dev = client->devices[i];
48 if (!strcmp(dev->id, id))
55 static void device_add(struct discover_client *client, struct device *device)
58 client->devices = talloc_realloc(client, client->devices,
59 struct device *, client->n_devices);
61 client->devices[client->n_devices - 1] = device;
62 talloc_steal(client, device);
64 if (client->ops.device_add)
65 client->ops.device_add(device, client->ops.cb_arg);
68 static void boot_option_add(struct discover_client *client,
69 struct boot_option *opt)
73 dev = find_device(client, opt->device_id);
75 /* we require that devices are already present before any boot options
79 talloc_steal(dev, opt);
81 if (client->ops.boot_option_add)
82 client->ops.boot_option_add(dev, opt, client->ops.cb_arg);
85 static void device_remove(struct discover_client *client, const char *id)
87 struct device *device = NULL;
90 for (i = 0; i < client->n_devices; i++) {
91 if (!strcmp(client->devices[i]->id, id)) {
92 device = client->devices[i];
100 /* remove the device from the client's device array */
102 memmove(&client->devices[i], &client->devices[i+1],
103 (client->n_devices - i) * sizeof(client->devices[0]));
104 client->devices = talloc_realloc(client, client->devices,
105 struct device *, client->n_devices);
108 client->ops.device_remove(device, client->ops.cb_arg);
113 static int discover_client_process(void *arg)
115 struct discover_client *client = arg;
116 struct pb_protocol_message *message;
117 struct boot_option *opt;
122 message = pb_protocol_read_message(client, client->fd);
127 switch (message->action) {
128 case PB_PROTOCOL_ACTION_DEVICE_ADD:
129 dev = talloc_zero(client, struct device);
130 list_init(&dev->boot_options);
132 rc = pb_protocol_deserialise_device(dev, message);
134 pb_log("%s: no device?\n", __func__);
138 device_add(client, dev);
140 case PB_PROTOCOL_ACTION_BOOT_OPTION_ADD:
141 opt = talloc_zero(client, struct boot_option);
143 rc = pb_protocol_deserialise_boot_option(opt, message);
145 pb_log("%s: no boot_option?\n", __func__);
149 boot_option_add(client, opt);
151 case PB_PROTOCOL_ACTION_DEVICE_REMOVE:
152 dev_id = pb_protocol_deserialise_string(client, message);
154 pb_log("%s: no device id?\n", __func__);
157 device_remove(client, dev_id);
160 pb_log("%s: unknown action %d\n", __func__, message->action);
167 struct discover_client* discover_client_init(struct waitset *waitset,
168 const struct discover_client_ops *ops, void *cb_arg)
170 struct discover_client *client;
171 struct sockaddr_un addr;
173 client = talloc(NULL, struct discover_client);
177 memcpy(&client->ops, ops, sizeof(client->ops));
178 client->ops.cb_arg = cb_arg;
180 client->fd = socket(AF_UNIX, SOCK_STREAM, 0);
181 if (client->fd < 0) {
182 pb_log("%s: socket: %s\n", __func__, strerror(errno));
186 talloc_set_destructor(client, discover_client_destructor);
188 client->n_devices = 0;
189 client->devices = NULL;
191 addr.sun_family = AF_UNIX;
192 strcpy(addr.sun_path, PB_SOCKET_PATH);
194 if (connect(client->fd, (struct sockaddr *)&addr, sizeof(addr))) {
195 pb_log("%s: connect: %s\n", __func__, strerror(errno));
199 waiter_register(waitset, client->fd, WAIT_IN, discover_client_process,
209 /* accessors for discovered devices */
210 int discover_client_device_count(struct discover_client *client)
212 return client->n_devices;
215 struct device *discover_client_get_device(struct discover_client *client,
218 if (index < 0 || index >= client->n_devices)
221 return client->devices[index];
224 static void create_boot_command(struct boot_command *command,
225 const struct device *device __attribute__((unused)),
226 const struct boot_option *boot_option,
227 const struct pb_boot_data *data)
230 command->option_id = boot_option->id;
231 command->boot_image_file = data->image;
232 command->initrd_file = data->initrd;
233 command->boot_args = data->args;
236 int discover_client_boot(struct discover_client *client,
237 const struct device *device,
238 const struct boot_option *boot_option,
239 const struct pb_boot_data *data)
241 struct pb_protocol_message *message;
242 struct boot_command boot_command;
245 create_boot_command(&boot_command, device, boot_option, data);
247 len = pb_protocol_boot_len(&boot_command);
249 message = pb_protocol_create_message(client,
250 PB_PROTOCOL_ACTION_BOOT, len);
255 pb_protocol_serialise_boot_command(&boot_command,
256 message->payload, len);
258 rc = pb_protocol_write_message(client->fd, message);