#include <asm/byteorder.h>
#include <talloc/talloc.h>
+#include <waiter/waiter.h>
+#include <log/log.h>
#include "pb-protocol/pb-protocol.h"
#include "list/list.h"
-#include "log.h"
-#include "waiter.h"
#include "device-handler.h"
+#include "discover-server.h"
struct discover_server {
int socket;
+ struct waitset *waitset;
struct waiter *waiter;
struct list clients;
struct device_handler *device_handler;
};
struct client {
+ struct discover_server *server;
struct list_item list;
int fd;
};
{
struct client *client;
- printf("current clients [%p,%p,%p]:\n",
+ pb_log("current clients [%p,%p,%p]:\n",
&server->clients.head,
server->clients.head.prev,
server->clients.head.next);
list_for_each_entry(&server->clients, client, list)
- printf("\t[%p,%p,%p] client: %d\n", &client->list,
+ pb_log("\t[%p,%p,%p] client: %d\n", &client->list,
client->list.prev, client->list.next,
client->fd);
}
-static int client_write_message(struct discover_server *server,
+static int client_write_message(
+ struct discover_server *server __attribute__((unused)),
struct client *client, struct pb_protocol_message *message)
{
int rc;
return rc;
}
-static int write_add_message(struct discover_server *server,
- struct client *client, struct device *dev)
+static int write_device_add_message(struct discover_server *server,
+ struct client *client, const struct device *dev)
{
struct pb_protocol_message *message;
int len;
len = pb_protocol_device_len(dev);
message = pb_protocol_create_message(client,
- PB_PROTOCOL_ACTION_ADD, len);
+ PB_PROTOCOL_ACTION_DEVICE_ADD, len);
if (!message)
return -1;
return client_write_message(server, client, message);
}
-static int write_remove_message(struct discover_server *server,
+static int write_boot_option_add_message(struct discover_server *server,
+ struct client *client, const struct boot_option *opt)
+{
+ struct pb_protocol_message *message;
+ int len;
+
+ len = pb_protocol_boot_option_len(opt);
+
+ message = pb_protocol_create_message(client,
+ PB_PROTOCOL_ACTION_BOOT_OPTION_ADD, len);
+ if (!message)
+ return -1;
+
+ pb_protocol_serialise_boot_option(opt, message->payload, len);
+
+ return client_write_message(server, client, message);
+}
+
+static int write_device_remove_message(struct discover_server *server,
struct client *client, char *dev_id)
{
struct pb_protocol_message *message;
len = strlen(dev_id) + sizeof(uint32_t);
message = pb_protocol_create_message(client,
- PB_PROTOCOL_ACTION_REMOVE, len);
+ PB_PROTOCOL_ACTION_DEVICE_REMOVE, len);
if (!message)
return -1;
return client_write_message(server, client, message);
}
-static int discover_server_process(void *arg)
+static int write_boot_status_message(struct discover_server *server,
+ struct client *client, const struct boot_status *status)
+{
+ struct pb_protocol_message *message;
+ int len;
+
+ len = pb_protocol_boot_status_len(status);
+
+ message = pb_protocol_create_message(client,
+ PB_PROTOCOL_ACTION_STATUS, len);
+ if (!message)
+ return -1;
+
+ pb_protocol_serialise_boot_status(status, message->payload, len);
+
+ return client_write_message(server, client, message);
+}
+
+static int discover_server_process_message(void *arg)
+{
+ struct pb_protocol_message *message;
+ struct boot_command *boot_command;
+ struct client *client = arg;
+ int rc;
+
+ message = pb_protocol_read_message(client, client->fd);
+
+ if (!message)
+ return 0;
+
+ if (message->action != PB_PROTOCOL_ACTION_BOOT) {
+ pb_log("%s: invalid action %d\n", __func__, message->action);
+ return 0;
+ }
+
+ boot_command = talloc(client, struct boot_command);
+
+ rc = pb_protocol_deserialise_boot_command(boot_command, message);
+ if (rc) {
+ pb_log("%s: no boot command?", __func__);
+ return 0;
+ }
+
+ device_handler_boot(client->server->device_handler, boot_command);
+
+ return 0;
+}
+
+static int discover_server_process_connection(void *arg)
{
struct discover_server *server = arg;
- struct device *devices;
struct client *client;
int fd, i, n_devices;
talloc_set_destructor(client, client_destructor);
client->fd = fd;
+ client->server = server;
/* send existing devices to client */
- n_devices = device_handler_get_current_devices(server->device_handler,
- &devices);
- for (i = 0; i < n_devices; i++)
- write_add_message(server, client, &devices[i]);
+ n_devices = device_handler_get_device_count(server->device_handler);
+ for (i = 0; i < n_devices; i++) {
+ const struct discover_boot_option *opt;
+ const struct discover_device *device;
+
+ device = device_handler_get_device(server->device_handler, i);
+ write_device_add_message(server, client, device->device);
+
+ list_for_each_entry(&device->boot_options, opt, list)
+ discover_server_notify_boot_option_add(server,
+ opt->option);
+
+ }
+
+ waiter_register(server->waitset, client->fd, WAIT_IN,
+ discover_server_process_message, client);
return 0;
}
-void discover_server_notify_add(struct discover_server *server,
+void discover_server_notify_device_add(struct discover_server *server,
struct device *device)
{
struct client *client;
list_for_each_entry(&server->clients, client, list)
- write_add_message(server, client, device);
+ write_device_add_message(server, client, device);
+
+}
+
+void discover_server_notify_boot_option_add(struct discover_server *server,
+ struct boot_option *boot_option)
+{
+ struct client *client;
+ list_for_each_entry(&server->clients, client, list)
+ write_boot_option_add_message(server, client, boot_option);
}
-void discover_server_notify_remove(struct discover_server *server,
+void discover_server_notify_device_remove(struct discover_server *server,
struct device *device)
{
struct client *client;
list_for_each_entry(&server->clients, client, list)
- write_remove_message(server, client, device->id);
+ write_device_remove_message(server, client, device->id);
+
+}
+void discover_server_notify_boot_status(struct discover_server *server,
+ struct boot_status *status)
+{
+ struct client *client;
+
+ list_for_each_entry(&server->clients, client, list)
+ write_boot_status_message(server, client, status);
}
void discover_server_set_device_source(struct discover_server *server,
server->device_handler = handler;
}
-struct discover_server *discover_server_init(void)
+struct discover_server *discover_server_init(struct waitset *waitset)
{
struct discover_server *server;
struct sockaddr_un addr;
return NULL;
server->waiter = NULL;
+ server->waitset = waitset;
list_init(&server->clients);
unlink(PB_SOCKET_PATH);
goto out_err;
}
- server->waiter = waiter_register(server->socket, WAIT_IN,
- discover_server_process, server);
+ server->waiter = waiter_register(server->waitset, server->socket,
+ WAIT_IN, discover_server_process_connection, server);
return server;
projects / petitboot / blobdiff