git.ozlabs.org Git - petitboot/blob - ui/common/discover-client.c

   1
   2 #include <errno.h>
   3 #include <unistd.h>
   4 #include <stdlib.h>
   5 #include <stdio.h>
   6 #include <stdint.h>
   7
   8 #include <sys/socket.h>
   9 #include <sys/un.h>
  10 #include <asm/byteorder.h>
  11
  12 #include <talloc/talloc.h>
  13 #include <log/log.h>
  14
  15 #include "discover-client.h"
  16 #include "pb-protocol/pb-protocol.h"
  17
  18 struct discover_client {
  19         int fd;
  20         struct discover_client_ops ops;
  21         int n_devices;
  22         struct device **devices;
  23 };
  24
  25 static int discover_client_destructor(void *arg)
  26 {
  27         struct discover_client *client = arg;
  28
  29         if (client->fd >= 0)
  30                 close(client->fd);
  31
  32         return 0;
  33 }
  34
  35 void discover_client_destroy(struct discover_client *client)
  36 {
  37         talloc_free(client);
  38 }
  39
  40 static void device_add(struct discover_client *client, struct device *device)
  41 {
  42         client->n_devices++;
  43         client->devices = talloc_realloc(client, client->devices,
  44                         struct device *, client->n_devices);
  45
  46         client->devices[client->n_devices - 1] = device;
  47         talloc_steal(client, device);
  48
  49         client->ops.device_add(device, client->ops.cb_arg);
  50 }
  51
  52 static void device_remove(struct discover_client *client, const char *id)
  53 {
  54         struct device *device = NULL;
  55         int i;
  56
  57         for (i = 0; i < client->n_devices; i++) {
  58                 if (!strcmp(client->devices[i]->id, id)) {
  59                         device = client->devices[i];
  60                         break;
  61                 }
  62         }
  63
  64         if (!device)
  65                 return;
  66
  67         /* remove the device from the client's device array */
  68         client->n_devices--;
  69         memmove(&client->devices[i], &client->devices[i+1],
  70                         (client->n_devices - i) * sizeof(client->devices[0]));
  71         client->devices = talloc_realloc(client, client->devices,
  72                         struct device *, client->n_devices);
  73
  74         /* notify the UI */
  75         client->ops.device_remove(device, client->ops.cb_arg);
  76
  77         talloc_free(device);
  78 }
  79
  80 static int discover_client_process(void *arg)
  81 {
  82         struct discover_client *client = arg;
  83         struct pb_protocol_message *message;
  84         struct device *dev;
  85         char *dev_id;
  86         int rc;
  87
  88         message = pb_protocol_read_message(client, client->fd);
  89
  90         if (!message)
  91                 return -1;
  92
  93         switch (message->action) {
  94         case PB_PROTOCOL_ACTION_ADD:
  95                 dev = talloc(client, struct device);
  96
  97                 rc = pb_protocol_deserialise_device(dev, message);
  98                 if (rc) {
  99                         pb_log("%s: no device?\n", __func__);
 100                         return 0;
 101                 }
 102
 103                 device_add(client, dev);
 104                 break;
 105         case PB_PROTOCOL_ACTION_REMOVE:
 106                 dev_id = pb_protocol_deserialise_string(client, message);
 107                 if (!dev_id) {
 108                         pb_log("%s: no device id?\n", __func__);
 109                         return 0;
 110                 }
 111                 device_remove(client, dev_id);
 112                 break;
 113         default:
 114                 pb_log("%s: unknown action %d\n", __func__, message->action);
 115         }
 116
 117
 118         return 0;
 119 }
 120
 121 struct discover_client* discover_client_init(struct waitset *waitset,
 122         const struct discover_client_ops *ops, void *cb_arg)
 123 {
 124         struct discover_client *client;
 125         struct sockaddr_un addr;
 126
 127         client = talloc(NULL, struct discover_client);
 128         if (!client)
 129                 return NULL;
 130
 131         memcpy(&client->ops, ops, sizeof(client->ops));
 132         client->ops.cb_arg = cb_arg;
 133
 134         client->fd = socket(AF_UNIX, SOCK_STREAM, 0);
 135         if (client->fd < 0) {
 136                 pb_log("%s: socket: %s\n", __func__, strerror(errno));
 137                 goto out_err;
 138         }
 139
 140         talloc_set_destructor(client, discover_client_destructor);
 141
 142         client->n_devices = 0;
 143         client->devices = NULL;
 144
 145         addr.sun_family = AF_UNIX;
 146         strcpy(addr.sun_path, PB_SOCKET_PATH);
 147
 148         if (connect(client->fd, (struct sockaddr *)&addr, sizeof(addr))) {
 149                 pb_log("%s: connect: %s\n", __func__, strerror(errno));
 150                 goto out_err;
 151         }
 152
 153         waiter_register(waitset, client->fd, WAIT_IN, discover_client_process,
 154                         client);
 155
 156         return client;
 157
 158 out_err:
 159         talloc_free(client);
 160         return NULL;
 161 }
 162
 163 /* accessors for discovered devices */
 164 int discover_client_device_count(struct discover_client *client)
 165 {
 166         return client->n_devices;
 167 }
 168
 169 struct device *discover_client_get_device(struct discover_client *client,
 170                 int index)
 171 {
 172         if (index < 0 || index >= client->n_devices)
 173                 return NULL;
 174
 175         return client->devices[index];
 176 }
 177
 178 static void create_boot_command(struct boot_command *command,
 179                 const struct device *device __attribute__((unused)),
 180                 const struct boot_option *boot_option,
 181                 const struct pb_boot_data *data)
 182 {
 183
 184         command->option_id = boot_option->id;
 185         command->boot_image_file = data->image;
 186         command->initrd_file = data->initrd;
 187         command->boot_args = data->args;
 188 }
 189
 190 int discover_client_boot(struct discover_client *client,
 191                 const struct device *device,
 192                 const struct boot_option *boot_option,
 193                 const struct pb_boot_data *data)
 194 {
 195         struct pb_protocol_message *message;
 196         struct boot_command boot_command;
 197         int len, rc;
 198
 199         create_boot_command(&boot_command, device, boot_option, data);
 200
 201         len = pb_protocol_boot_len(&boot_command);
 202
 203         message = pb_protocol_create_message(client,
 204                         PB_PROTOCOL_ACTION_BOOT, len);
 205
 206         if (!message)
 207                 return -1;
 208
 209         pb_protocol_serialise_boot_command(&boot_command,
 210                         message->payload, len);
 211
 212         rc = pb_protocol_write_message(client->fd, message);
 213
 214         return rc;
 215 }