9 #include <sys/socket.h>
11 #include <asm/byteorder.h>
13 #include <pb-config/pb-config.h>
14 #include <talloc/talloc.h>
15 #include <waiter/waiter.h>
18 #include "pb-protocol/pb-protocol.h"
19 #include "list/list.h"
21 #include "device-handler.h"
22 #include "discover-server.h"
26 struct discover_server {
28 struct waitset *waitset;
29 struct waiter *waiter;
31 struct device_handler *device_handler;
35 struct discover_server *server;
36 struct list_item list;
37 struct waiter *waiter;
43 static int server_destructor(void *arg)
45 struct discover_server *server = arg;
48 waiter_remove(server->waiter);
50 if (server->socket >= 0)
51 close(server->socket);
56 static int client_destructor(void *arg)
58 struct client *client = arg;
64 waiter_remove(client->waiter);
66 list_remove(&client->list);
72 static void print_clients(struct discover_server *server)
73 __attribute__((unused));
75 static void print_clients(struct discover_server *server)
77 struct client *client;
79 pb_debug("current clients [%p,%p,%p]:\n",
80 &server->clients.head,
81 server->clients.head.prev,
82 server->clients.head.next);
83 list_for_each_entry(&server->clients, client, list)
84 pb_debug("\t[%p,%p,%p] client: %d\n", &client->list,
85 client->list.prev, client->list.next,
89 static int client_write_message(
90 struct discover_server *server __attribute__((unused)),
91 struct client *client, struct pb_protocol_message *message)
95 if (client->remote_closed)
98 rc = pb_protocol_write_message(client->fd, message);
100 client->remote_closed = true;
105 static int write_device_add_message(struct discover_server *server,
106 struct client *client, const struct device *dev)
108 struct pb_protocol_message *message;
111 len = pb_protocol_device_len(dev);
113 message = pb_protocol_create_message(client,
114 PB_PROTOCOL_ACTION_DEVICE_ADD, len);
118 pb_protocol_serialise_device(dev, message->payload, len);
120 return client_write_message(server, client, message);
123 static int write_boot_option_add_message(struct discover_server *server,
124 struct client *client, const struct boot_option *opt)
126 struct pb_protocol_message *message;
129 len = pb_protocol_boot_option_len(opt);
131 message = pb_protocol_create_message(client,
132 PB_PROTOCOL_ACTION_BOOT_OPTION_ADD, len);
136 pb_protocol_serialise_boot_option(opt, message->payload, len);
138 return client_write_message(server, client, message);
141 static int write_device_remove_message(struct discover_server *server,
142 struct client *client, char *dev_id)
144 struct pb_protocol_message *message;
147 len = strlen(dev_id) + sizeof(uint32_t);
149 message = pb_protocol_create_message(client,
150 PB_PROTOCOL_ACTION_DEVICE_REMOVE, len);
154 pb_protocol_serialise_string(message->payload, dev_id);
156 return client_write_message(server, client, message);
159 static int write_boot_status_message(struct discover_server *server,
160 struct client *client, const struct boot_status *status)
162 struct pb_protocol_message *message;
165 len = pb_protocol_boot_status_len(status);
167 message = pb_protocol_create_message(client,
168 PB_PROTOCOL_ACTION_STATUS, len);
172 pb_protocol_serialise_boot_status(status, message->payload, len);
174 return client_write_message(server, client, message);
177 static int write_system_info_message(struct discover_server *server,
178 struct client *client, const struct system_info *sysinfo)
180 struct pb_protocol_message *message;
183 len = pb_protocol_system_info_len(sysinfo);
185 message = pb_protocol_create_message(client,
186 PB_PROTOCOL_ACTION_SYSTEM_INFO, len);
190 pb_protocol_serialise_system_info(sysinfo, message->payload, len);
192 return client_write_message(server, client, message);
195 static int write_config_message(struct discover_server *server,
196 struct client *client, const struct config *config)
198 struct pb_protocol_message *message;
201 len = pb_protocol_config_len(config);
203 message = pb_protocol_create_message(client,
204 PB_PROTOCOL_ACTION_CONFIG, len);
208 pb_protocol_serialise_config(config, message->payload, len);
210 return client_write_message(server, client, message);
213 static int discover_server_process_message(void *arg)
215 struct pb_protocol_message *message;
216 struct boot_command *boot_command;
217 struct client *client = arg;
218 struct config *config;
221 message = pb_protocol_read_message(client, client->fd);
229 switch (message->action) {
230 case PB_PROTOCOL_ACTION_BOOT:
231 boot_command = talloc(client, struct boot_command);
233 rc = pb_protocol_deserialise_boot_command(boot_command,
236 pb_log("%s: no boot command?", __func__);
240 device_handler_boot(client->server->device_handler,
244 case PB_PROTOCOL_ACTION_CANCEL_DEFAULT:
245 device_handler_cancel_default(client->server->device_handler);
248 case PB_PROTOCOL_ACTION_CONFIG:
249 config = talloc_zero(client, struct config);
251 rc = pb_protocol_deserialise_config(config, message);
253 pb_log("%s: no config?", __func__);
257 device_handler_update_config(client->server->device_handler,
262 pb_log("%s: invalid action %d\n", __func__, message->action);
270 static int discover_server_process_connection(void *arg)
272 struct discover_server *server = arg;
273 int fd, rc, i, n_devices;
274 struct client *client;
276 /* accept the incoming connection */
277 fd = accept(server->socket, NULL, 0);
279 pb_log("accept: %s\n", strerror(errno));
283 /* add to our list of clients */
284 client = talloc_zero(server, struct client);
285 list_add(&server->clients, &client->list);
287 talloc_set_destructor(client, client_destructor);
290 client->server = server;
291 client->waiter = waiter_register_io(server->waitset, client->fd,
292 WAIT_IN, discover_server_process_message,
295 /* send sysinfo to client */
296 rc = write_system_info_message(server, client, system_info_get());
300 /* send config to client */
301 rc = write_config_message(server, client, config_get());
305 /* send existing devices to client */
306 n_devices = device_handler_get_device_count(server->device_handler);
307 for (i = 0; i < n_devices; i++) {
308 const struct discover_boot_option *opt;
309 const struct discover_device *device;
311 device = device_handler_get_device(server->device_handler, i);
312 rc = write_device_add_message(server, client, device->device);
316 list_for_each_entry(&device->boot_options, opt, list) {
317 rc = write_boot_option_add_message(server, client,
327 void discover_server_notify_device_add(struct discover_server *server,
328 struct device *device)
330 struct client *client;
332 list_for_each_entry(&server->clients, client, list)
333 write_device_add_message(server, client, device);
337 void discover_server_notify_boot_option_add(struct discover_server *server,
338 struct boot_option *boot_option)
340 struct client *client;
342 list_for_each_entry(&server->clients, client, list)
343 write_boot_option_add_message(server, client, boot_option);
346 void discover_server_notify_device_remove(struct discover_server *server,
347 struct device *device)
349 struct client *client;
351 list_for_each_entry(&server->clients, client, list)
352 write_device_remove_message(server, client, device->id);
356 void discover_server_notify_boot_status(struct discover_server *server,
357 struct boot_status *status)
359 struct client *client;
361 list_for_each_entry(&server->clients, client, list)
362 write_boot_status_message(server, client, status);
365 void discover_server_notify_system_info(struct discover_server *server,
366 const struct system_info *sysinfo)
368 struct client *client;
370 list_for_each_entry(&server->clients, client, list)
371 write_system_info_message(server, client, sysinfo);
374 void discover_server_notify_config(struct discover_server *server,
375 const struct config *config)
377 struct client *client;
379 list_for_each_entry(&server->clients, client, list)
380 write_config_message(server, client, config);
383 void discover_server_set_device_source(struct discover_server *server,
384 struct device_handler *handler)
386 server->device_handler = handler;
389 struct discover_server *discover_server_init(struct waitset *waitset)
391 struct discover_server *server;
392 struct sockaddr_un addr;
394 server = talloc(NULL, struct discover_server);
398 server->waiter = NULL;
399 server->waitset = waitset;
400 list_init(&server->clients);
402 unlink(PB_SOCKET_PATH);
404 server->socket = socket(AF_UNIX, SOCK_STREAM, 0);
405 if (server->socket < 0) {
406 pb_log("error creating server socket: %s\n", strerror(errno));
410 talloc_set_destructor(server, server_destructor);
412 addr.sun_family = AF_UNIX;
413 strcpy(addr.sun_path, PB_SOCKET_PATH);
415 if (bind(server->socket, (struct sockaddr *)&addr, sizeof(addr))) {
416 pb_log("error binding server socket: %s\n", strerror(errno));
420 if (listen(server->socket, 8)) {
421 pb_log("server socket listen: %s\n", strerror(errno));
425 server->waiter = waiter_register_io(server->waitset, server->socket,
426 WAIT_IN, discover_server_process_connection, server);
435 void discover_server_destroy(struct discover_server *server)