git.ozlabs.org Git - petitboot/blob - lib/pb-protocol/pb-protocol.c

   1
   2 #include <assert.h>
   3 #include <errno.h>
   4 #include <string.h>
   5 #include <stdbool.h>
   6 #include <stdint.h>
   7 #include <asm/byteorder.h>
   8
   9 #include <talloc/talloc.h>
  10 #include <list/list.h>
  11 #include <log/log.h>
  12
  13 #include "pb-protocol.h"
  14
  15
  16 /* Message format:
  17  *
  18  * 4-byte action, determines the remaining message content
  19  * 4-byte total payload len
  20  *   - not including action and payload len header
  21  *
  22  * action = 0x1: device add message
  23  *  payload:
  24  *   4-byte len, id
  25  *   1-byte type
  26  *   4-byte len, name
  27  *   4-byte len, description
  28  *   4-byte len, icon_file
  29  *
  30  *   4-byte option count
  31  *   for each option:
  32  *    4-byte len, id
  33  *    4-byte len, name
  34  *    4-byte len, description
  35  *    4-byte len, icon_file
  36  *    4-byte len, boot_image_file
  37  *    4-byte len, initrd_file
  38  *    4-byte len, dtb_file
  39  *    4-byte len, boot_args
  40  *
  41  * action = 0x2: device remove message
  42  *  payload:
  43  *   4-byte len, id
  44  *
  45  * action = 0x3: boot
  46  *  payload:
  47  *   4-byte len, boot option id
  48  *   4-byte len, boot_image_file
  49  *   4-byte len, initrd_file
  50  *   4-byte len, dtb_file
  51  *   4-byte len, boot_args
  52  *
  53  */
  54
  55 void pb_protocol_dump_device(const struct device *dev, const char *text,
  56         FILE *stream)
  57 {
  58         struct boot_option *opt;
  59
  60         fprintf(stream, "%snew dev:\n", text);
  61         fprintf(stream, "%s\tid:   %s\n", text, dev->id);
  62         fprintf(stream, "%s\tname: %s\n", text, dev->name);
  63         fprintf(stream, "%s\tdesc: %s\n", text, dev->description);
  64         fprintf(stream, "%s\ticon: %s\n", text, dev->icon_file);
  65         fprintf(stream, "%s\tboot options:\n", text);
  66         list_for_each_entry(&dev->boot_options, opt, list) {
  67                 fprintf(stream, "%s\t\tid:   %s\n", text, opt->id);
  68                 fprintf(stream, "%s\t\tname: %s\n", text, opt->name);
  69                 fprintf(stream, "%s\t\tdesc: %s\n", text, opt->description);
  70                 fprintf(stream, "%s\t\ticon: %s\n", text, opt->icon_file);
  71                 fprintf(stream, "%s\t\tboot: %s\n", text, opt->boot_image_file);
  72                 fprintf(stream, "%s\t\tinit: %s\n", text, opt->initrd_file);
  73                 fprintf(stream, "%s\t\tdtb:  %s\n", text, opt->dtb_file);
  74                 fprintf(stream, "%s\t\targs: %s\n", text, opt->boot_args);
  75         }
  76 }
  77
  78 int pb_protocol_device_cmp(const struct device *a, const struct device *b)
  79 {
  80         return !strcmp(a->id, b->id);
  81 }
  82
  83 int pb_protocol_boot_option_cmp(const struct boot_option *a,
  84         const struct boot_option *b)
  85 {
  86         return !strcmp(a->id, b->id);
  87 }
  88
  89 /* Write a string into the buffer, starting at pos.
  90  *
  91  * Returns the total length used for the write, including length header.
  92  */
  93 int pb_protocol_serialise_string(char *pos, const char *str)
  94 {
  95         int len = 0;
  96
  97         if (str)
  98                 len = strlen(str);
  99
 100         *(uint32_t *)pos = __cpu_to_be32(len);
 101         pos += sizeof(uint32_t);
 102
 103         memcpy(pos, str, len);
 104
 105         return len + sizeof(uint32_t);
 106 }
 107
 108 /* Read a string from a buffer, allocating the new string as necessary.
 109  *
 110  * @param[in] ctx       The talloc context to base the allocation on
 111  * @param[in,out] pos   Where to start reading
 112  * @param[in,out] len   The amount of data remaining in the buffer
 113  * @param[out] str      Pointer to resuling string
 114  * @return              zero on success, non-zero on failure
 115  */
 116 static int read_string(void *ctx, const char **pos, unsigned int *len,
 117         char **str)
 118 {
 119         uint32_t str_len, read_len;
 120
 121         if (*len < sizeof(uint32_t))
 122                 return -1;
 123
 124         str_len = __be32_to_cpu(*(uint32_t *)(*pos));
 125         read_len = sizeof(uint32_t);
 126
 127         if (read_len + str_len > *len)
 128                 return -1;
 129
 130         if (str_len == 0)
 131                 *str = NULL;
 132         else
 133                 *str = talloc_strndup(ctx, *pos + read_len, str_len);
 134
 135         read_len += str_len;
 136
 137         /* all ok, update the caller's pointers */
 138         *pos += read_len;
 139         *len -= read_len;
 140
 141         return 0;
 142 }
 143
 144 static int read_u32(const char **pos, unsigned int *len, unsigned int *p)
 145 {
 146         if (*len < sizeof(uint32_t))
 147                 return -1;
 148
 149         *p = (unsigned int)__be32_to_cpu(*(uint32_t *)(*pos));
 150         *pos += sizeof(uint32_t);
 151         *len -= sizeof(uint32_t);
 152
 153         return 0;
 154 }
 155
 156 char *pb_protocol_deserialise_string(void *ctx,
 157                 const struct pb_protocol_message *message)
 158 {
 159         const char *buf;
 160         char *str;
 161         unsigned int len;
 162
 163         len = message->payload_len;
 164         buf = message->payload;
 165
 166         if (read_string(ctx, &buf, &len, &str))
 167                 return NULL;
 168
 169         return str;
 170 }
 171
 172 static int optional_strlen(const char *str)
 173 {
 174         if (!str)
 175                 return 0;
 176         return strlen(str);
 177 }
 178
 179 int pb_protocol_device_len(const struct device *dev)
 180 {
 181         return  4 + optional_strlen(dev->id) +
 182                 sizeof(dev->type) +
 183                 4 + optional_strlen(dev->name) +
 184                 4 + optional_strlen(dev->description) +
 185                 4 + optional_strlen(dev->icon_file);
 186 }
 187
 188 int pb_protocol_boot_option_len(const struct boot_option *opt)
 189 {
 190
 191         return  4 + optional_strlen(opt->device_id) +
 192                 4 + optional_strlen(opt->id) +
 193                 4 + optional_strlen(opt->name) +
 194                 4 + optional_strlen(opt->description) +
 195                 4 + optional_strlen(opt->icon_file) +
 196                 4 + optional_strlen(opt->boot_image_file) +
 197                 4 + optional_strlen(opt->initrd_file) +
 198                 4 + optional_strlen(opt->dtb_file) +
 199                 4 + optional_strlen(opt->boot_args) +
 200                 sizeof(opt->is_default);
 201 }
 202
 203 int pb_protocol_boot_len(const struct boot_command *boot)
 204 {
 205         return  4 + optional_strlen(boot->option_id) +
 206                 4 + optional_strlen(boot->boot_image_file) +
 207                 4 + optional_strlen(boot->initrd_file) +
 208                 4 + optional_strlen(boot->dtb_file) +
 209                 4 + optional_strlen(boot->boot_args);
 210 }
 211
 212 int pb_protocol_boot_status_len(const struct boot_status *status)
 213 {
 214         return  4 +
 215                 4 + optional_strlen(status->message) +
 216                 4 + optional_strlen(status->detail) +
 217                 4;
 218 }
 219
 220 int pb_protocol_system_info_len(const struct system_info *sysinfo)
 221 {
 222         unsigned int len, i;
 223
 224         len =   4 + optional_strlen(sysinfo->type) +
 225                 4 + optional_strlen(sysinfo->identifier) +
 226                 4 + 4;
 227
 228         for (i = 0; i < sysinfo->n_interfaces; i++) {
 229                 struct interface_info *if_info = sysinfo->interfaces[i];
 230                 len +=  4 + if_info->hwaddr_size +
 231                         4 + optional_strlen(if_info->name) +
 232                         sizeof(if_info->link);
 233         }
 234
 235         for (i = 0; i < sysinfo->n_blockdevs; i++) {
 236                 struct blockdev_info *bd_info = sysinfo->blockdevs[i];
 237                 len +=  4 + optional_strlen(bd_info->name) +
 238                         4 + optional_strlen(bd_info->uuid) +
 239                         4 + optional_strlen(bd_info->mountpoint);
 240         }
 241
 242         return len;
 243 }
 244
 245 static int pb_protocol_interface_config_len(struct interface_config *conf)
 246 {
 247         unsigned int len;
 248
 249         len =   sizeof(conf->hwaddr) +
 250                 4 /* conf->ignore */;
 251
 252         if (conf->ignore)
 253                 return len;
 254
 255         len += 4 /* conf->method */;
 256
 257         if (conf->method == CONFIG_METHOD_STATIC) {
 258                 len += 4 + optional_strlen(conf->static_config.address);
 259                 len += 4 + optional_strlen(conf->static_config.gateway);
 260         }
 261
 262         return len;
 263 }
 264
 265 int pb_protocol_config_len(const struct config *config)
 266 {
 267         unsigned int i, len;
 268
 269         len =   4 /* config->autoboot_enabled */ +
 270                 4 /* config->autoboot_timeout_sec */;
 271
 272         len += 4;
 273         for (i = 0; i < config->network.n_interfaces; i++)
 274                 len += pb_protocol_interface_config_len(
 275                                 config->network.interfaces[i]);
 276
 277         len += 4;
 278         for (i = 0; i < config->network.n_dns_servers; i++)
 279                 len += 4 + optional_strlen(config->network.dns_servers[i]);
 280
 281         len += 4;
 282         len += config->n_boot_priorities * 4;
 283
 284         return len;
 285 }
 286
 287 int pb_protocol_serialise_device(const struct device *dev,
 288                 char *buf, int buf_len)
 289 {
 290         char *pos = buf;
 291
 292         pos += pb_protocol_serialise_string(pos, dev->id);
 293         *(enum device_type *)pos = dev->type;
 294         pos += sizeof(enum device_type);
 295         pos += pb_protocol_serialise_string(pos, dev->name);
 296         pos += pb_protocol_serialise_string(pos, dev->description);
 297         pos += pb_protocol_serialise_string(pos, dev->icon_file);
 298
 299         assert(pos <= buf + buf_len);
 300         (void)buf_len;
 301
 302         return 0;
 303 }
 304
 305 int pb_protocol_serialise_boot_option(const struct boot_option *opt,
 306                 char *buf, int buf_len)
 307 {
 308         char *pos = buf;
 309
 310         pos += pb_protocol_serialise_string(pos, opt->device_id);
 311         pos += pb_protocol_serialise_string(pos, opt->id);
 312         pos += pb_protocol_serialise_string(pos, opt->name);
 313         pos += pb_protocol_serialise_string(pos, opt->description);
 314         pos += pb_protocol_serialise_string(pos, opt->icon_file);
 315         pos += pb_protocol_serialise_string(pos, opt->boot_image_file);
 316         pos += pb_protocol_serialise_string(pos, opt->initrd_file);
 317         pos += pb_protocol_serialise_string(pos, opt->dtb_file);
 318         pos += pb_protocol_serialise_string(pos, opt->boot_args);
 319
 320         *(bool *)pos = opt->is_default;
 321         pos += sizeof(bool);
 322
 323         assert(pos <= buf + buf_len);
 324         (void)buf_len;
 325
 326         return 0;
 327 }
 328
 329 int pb_protocol_serialise_boot_command(const struct boot_command *boot,
 330                 char *buf, int buf_len)
 331 {
 332         char *pos = buf;
 333
 334         pos += pb_protocol_serialise_string(pos, boot->option_id);
 335         pos += pb_protocol_serialise_string(pos, boot->boot_image_file);
 336         pos += pb_protocol_serialise_string(pos, boot->initrd_file);
 337         pos += pb_protocol_serialise_string(pos, boot->dtb_file);
 338         pos += pb_protocol_serialise_string(pos, boot->boot_args);
 339
 340         assert(pos <= buf + buf_len);
 341         (void)buf_len;
 342
 343         return 0;
 344 }
 345
 346 int pb_protocol_serialise_boot_status(const struct boot_status *status,
 347                 char *buf, int buf_len)
 348 {
 349         char *pos = buf;
 350
 351         *(uint32_t *)pos = __cpu_to_be32(status->type);
 352         pos += sizeof(uint32_t);
 353
 354         pos += pb_protocol_serialise_string(pos, status->message);
 355         pos += pb_protocol_serialise_string(pos, status->detail);
 356
 357         *(uint32_t *)pos = __cpu_to_be32(status->type);
 358         pos += sizeof(uint32_t);
 359
 360         assert(pos <= buf + buf_len);
 361         (void)buf_len;
 362
 363         return 0;
 364 }
 365
 366 int pb_protocol_serialise_system_info(const struct system_info *sysinfo,
 367                 char *buf, int buf_len)
 368 {
 369         char *pos = buf;
 370         unsigned int i;
 371
 372         pos += pb_protocol_serialise_string(pos, sysinfo->type);
 373         pos += pb_protocol_serialise_string(pos, sysinfo->identifier);
 374
 375         *(uint32_t *)pos = __cpu_to_be32(sysinfo->n_interfaces);
 376         pos += sizeof(uint32_t);
 377
 378         for (i = 0; i < sysinfo->n_interfaces; i++) {
 379                 struct interface_info *if_info = sysinfo->interfaces[i];
 380
 381                 *(uint32_t *)pos = __cpu_to_be32(if_info->hwaddr_size);
 382                 pos += sizeof(uint32_t);
 383
 384                 memcpy(pos, if_info->hwaddr, if_info->hwaddr_size);
 385                 pos += if_info->hwaddr_size;
 386
 387                 pos += pb_protocol_serialise_string(pos, if_info->name);
 388
 389                 *(bool *)pos = if_info->link;
 390                 pos += sizeof(bool);
 391         }
 392
 393         *(uint32_t *)pos = __cpu_to_be32(sysinfo->n_blockdevs);
 394         pos += sizeof(uint32_t);
 395
 396         for (i = 0; i < sysinfo->n_blockdevs; i++) {
 397                 struct blockdev_info *bd_info = sysinfo->blockdevs[i];
 398
 399                 pos += pb_protocol_serialise_string(pos, bd_info->name);
 400                 pos += pb_protocol_serialise_string(pos, bd_info->uuid);
 401                 pos += pb_protocol_serialise_string(pos, bd_info->mountpoint);
 402         }
 403
 404         assert(pos <= buf + buf_len);
 405         (void)buf_len;
 406
 407         return 0;
 408 }
 409
 410 static int pb_protocol_serialise_config_interface(char *buf,
 411                 struct interface_config *conf)
 412 {
 413         char *pos = buf;
 414
 415         memcpy(pos, conf->hwaddr, sizeof(conf->hwaddr));
 416         pos += sizeof(conf->hwaddr);
 417
 418         *(uint32_t *)pos = conf->ignore;
 419         pos += 4;
 420
 421         if (conf->ignore)
 422                 return pos - buf;
 423
 424         *(uint32_t *)pos = __cpu_to_be32(conf->method);
 425         pos += 4;
 426
 427         if (conf->method == CONFIG_METHOD_STATIC) {
 428                 pos += pb_protocol_serialise_string(pos,
 429                                 conf->static_config.address);
 430                 pos += pb_protocol_serialise_string(pos,
 431                                 conf->static_config.gateway);
 432         }
 433
 434         return pos - buf;
 435 }
 436
 437 int pb_protocol_serialise_config(const struct config *config,
 438                 char *buf, int buf_len)
 439 {
 440         char *pos = buf;
 441         unsigned int i;
 442
 443         *(uint32_t *)pos = config->autoboot_enabled;
 444         pos += 4;
 445
 446         *(uint32_t *)pos = __cpu_to_be32(config->autoboot_timeout_sec);
 447         pos += 4;
 448
 449         *(uint32_t *)pos = __cpu_to_be32(config->network.n_interfaces);
 450         pos += 4;
 451         for (i = 0; i < config->network.n_interfaces; i++) {
 452                 struct interface_config *iface =
 453                         config->network.interfaces[i];
 454                 pos += pb_protocol_serialise_config_interface(pos, iface);
 455         }
 456
 457         *(uint32_t *)pos = __cpu_to_be32(config->network.n_dns_servers);
 458         pos += 4;
 459         for (i = 0; i < config->network.n_dns_servers; i++) {
 460                 pos += pb_protocol_serialise_string(pos,
 461                                 config->network.dns_servers[i]);
 462         }
 463
 464         *(uint32_t *)pos = __cpu_to_be32(config->n_boot_priorities);
 465         pos += 4;
 466         for (i = 0; i < config->n_boot_priorities; i++) {
 467                 *(uint32_t *)pos = __cpu_to_be32(config->boot_priorities[i].type);
 468                 pos += 4;
 469         }
 470
 471         assert(pos <= buf + buf_len);
 472         (void)buf_len;
 473
 474         return 0;
 475 }
 476
 477 int pb_protocol_write_message(int fd, struct pb_protocol_message *message)
 478 {
 479         int total_len, rc;
 480         char *pos;
 481
 482         total_len = sizeof(*message) + message->payload_len;
 483
 484         message->payload_len = __cpu_to_be32(message->payload_len);
 485         message->action = __cpu_to_be32(message->action);
 486
 487         for (pos = (void *)message; total_len;) {
 488                 rc = write(fd, pos, total_len);
 489
 490                 if (rc <= 0)
 491                         break;
 492
 493                 total_len -= rc;
 494                 pos += rc;
 495         }
 496
 497         talloc_free(message);
 498
 499         if (!total_len)
 500                 return 0;
 501
 502         pb_log("%s: failed: %s\n", __func__, strerror(errno));
 503         return -1;
 504 }
 505
 506 struct pb_protocol_message *pb_protocol_create_message(void *ctx,
 507                 enum pb_protocol_action action, int payload_len)
 508 {
 509         struct pb_protocol_message *message;
 510
 511         if (payload_len > PB_PROTOCOL_MAX_PAYLOAD_SIZE) {
 512                 pb_log("%s: payload too big %u/%u\n", __func__, payload_len,
 513                         PB_PROTOCOL_MAX_PAYLOAD_SIZE);
 514                 return NULL;
 515         }
 516
 517         message = talloc_size(ctx, sizeof(*message) + payload_len);
 518
 519         /* we convert these to big-endian in write_message() */
 520         message->action = action;
 521         message->payload_len = payload_len;
 522
 523         return message;
 524
 525 }
 526
 527 struct pb_protocol_message *pb_protocol_read_message(void *ctx, int fd)
 528 {
 529         struct pb_protocol_message *message, m;
 530         int rc;
 531         unsigned int len;
 532
 533         /* use the stack for the initial 8-byte read */
 534
 535         rc = read(fd, &m, sizeof(m));
 536         if (rc != sizeof(m))
 537                 return NULL;
 538
 539         m.payload_len = __be32_to_cpu(m.payload_len);
 540         m.action = __be32_to_cpu(m.action);
 541
 542         if (m.payload_len > PB_PROTOCOL_MAX_PAYLOAD_SIZE) {
 543                 pb_log("%s: payload too big %u/%u\n", __func__, m.payload_len,
 544                         PB_PROTOCOL_MAX_PAYLOAD_SIZE);
 545                 return NULL;
 546         }
 547
 548         message = talloc_size(ctx, sizeof(m) + m.payload_len);
 549         memcpy(message, &m, sizeof(m));
 550
 551         for (len = 0; len < m.payload_len;) {
 552                 rc = read(fd, message->payload + len, m.payload_len - len);
 553
 554                 if (rc <= 0) {
 555                         talloc_free(message);
 556                         pb_log("%s: failed (%u): %s\n", __func__, len,
 557                                 strerror(errno));
 558                         return NULL;
 559                 }
 560
 561                 len += rc;
 562         }
 563
 564         return message;
 565 }
 566
 567
 568 int pb_protocol_deserialise_device(struct device *dev,
 569                 const struct pb_protocol_message *message)
 570 {
 571         unsigned int len;
 572         const char *pos;
 573         int rc = -1;
 574
 575         len = message->payload_len;
 576         pos = message->payload;
 577
 578         if (read_string(dev, &pos, &len, &dev->id))
 579                 goto out;
 580
 581         if (len < sizeof(enum device_type))
 582                 goto out;
 583         dev->type = *(enum device_type *)(pos);
 584         pos += sizeof(enum device_type);
 585         len -= sizeof(enum device_type);
 586
 587         if (read_string(dev, &pos, &len, &dev->name))
 588                 goto out;
 589
 590         if (read_string(dev, &pos, &len, &dev->description))
 591                 goto out;
 592
 593         if (read_string(dev, &pos, &len, &dev->icon_file))
 594                 goto out;
 595
 596         rc = 0;
 597
 598 out:
 599         return rc;
 600 }
 601
 602 int pb_protocol_deserialise_boot_option(struct boot_option *opt,
 603                 const struct pb_protocol_message *message)
 604 {
 605         unsigned int len;
 606         const char *pos;
 607         int rc = -1;
 608
 609         len = message->payload_len;
 610         pos = message->payload;
 611
 612         if (read_string(opt, &pos, &len, &opt->device_id))
 613                 goto out;
 614
 615         if (read_string(opt, &pos, &len, &opt->id))
 616                 goto out;
 617
 618         if (read_string(opt, &pos, &len, &opt->name))
 619                 goto out;
 620
 621         if (read_string(opt, &pos, &len, &opt->description))
 622                 goto out;
 623
 624         if (read_string(opt, &pos, &len, &opt->icon_file))
 625                 goto out;
 626
 627         if (read_string(opt, &pos, &len, &opt->boot_image_file))
 628                 goto out;
 629
 630         if (read_string(opt, &pos, &len, &opt->initrd_file))
 631                 goto out;
 632
 633         if (read_string(opt, &pos, &len, &opt->dtb_file))
 634                 goto out;
 635
 636         if (read_string(opt, &pos, &len, &opt->boot_args))
 637                 goto out;
 638
 639         if (len < sizeof(bool))
 640                 goto out;
 641         opt->is_default = *(bool *)(pos);
 642
 643         rc = 0;
 644
 645 out:
 646         return rc;
 647 }
 648
 649 int pb_protocol_deserialise_boot_command(struct boot_command *cmd,
 650                 const struct pb_protocol_message *message)
 651 {
 652         unsigned int len;
 653         const char *pos;
 654         int rc = -1;
 655
 656         len = message->payload_len;
 657         pos = message->payload;
 658
 659         if (read_string(cmd, &pos, &len, &cmd->option_id))
 660                 goto out;
 661
 662         if (read_string(cmd, &pos, &len, &cmd->boot_image_file))
 663                 goto out;
 664
 665         if (read_string(cmd, &pos, &len, &cmd->initrd_file))
 666                 goto out;
 667
 668         if (read_string(cmd, &pos, &len, &cmd->dtb_file))
 669                 goto out;
 670
 671         if (read_string(cmd, &pos, &len, &cmd->boot_args))
 672                 goto out;
 673
 674         rc = 0;
 675
 676 out:
 677         return rc;
 678 }
 679
 680 int pb_protocol_deserialise_boot_status(struct boot_status *status,
 681                 const struct pb_protocol_message *message)
 682 {
 683         unsigned int len;
 684         const char *pos;
 685         int rc = -1;
 686
 687         len = message->payload_len;
 688         pos = message->payload;
 689
 690         /* first up, the type enum... */
 691         if (len < sizeof(uint32_t))
 692                 goto out;
 693
 694         status->type = __be32_to_cpu(*(uint32_t *)(pos));
 695
 696         switch (status->type) {
 697         case BOOT_STATUS_ERROR:
 698         case BOOT_STATUS_INFO:
 699                 break;
 700         default:
 701                 goto out;
 702         }
 703
 704         pos += sizeof(uint32_t);
 705         len -= sizeof(uint32_t);
 706
 707         /* message and detail strings */
 708         if (read_string(status, &pos, &len, &status->message))
 709                 goto out;
 710
 711         if (read_string(status, &pos, &len, &status->detail))
 712                 goto out;
 713
 714         /* and finally, progress */
 715         if (len < sizeof(uint32_t))
 716                 goto out;
 717
 718         status->progress = __be32_to_cpu(*(uint32_t *)(pos));
 719
 720         /* clamp to 100% */
 721         if (status->progress > 100)
 722                 status->progress = 100;
 723
 724         rc = 0;
 725
 726 out:
 727         return rc;
 728 }
 729
 730 int pb_protocol_deserialise_system_info(struct system_info *sysinfo,
 731                 const struct pb_protocol_message *message)
 732 {
 733         unsigned int len, i;
 734         const char *pos;
 735         int rc = -1;
 736
 737         len = message->payload_len;
 738         pos = message->payload;
 739
 740         /* type and identifier strings */
 741         if (read_string(sysinfo, &pos, &len, &sysinfo->type))
 742                 goto out;
 743
 744         if (read_string(sysinfo, &pos, &len, &sysinfo->identifier))
 745                 goto out;
 746
 747         /* number of interfaces */
 748         if (read_u32(&pos, &len, &sysinfo->n_interfaces))
 749                 goto out;
 750
 751         sysinfo->interfaces = talloc_array(sysinfo, struct interface_info *,
 752                         sysinfo->n_interfaces);
 753
 754         for (i = 0; i < sysinfo->n_interfaces; i++) {
 755                 struct interface_info *if_info = talloc(sysinfo,
 756                                                         struct interface_info);
 757
 758                 if (read_u32(&pos, &len, &if_info->hwaddr_size))
 759                         goto out;
 760
 761                 if (len < if_info->hwaddr_size)
 762                         goto out;
 763
 764                 if_info->hwaddr = talloc_memdup(if_info, pos,
 765                                                 if_info->hwaddr_size);
 766                 pos += if_info->hwaddr_size;
 767                 len -= if_info->hwaddr_size;
 768
 769                 if (read_string(if_info, &pos, &len, &if_info->name))
 770                         goto out;
 771
 772                 if_info->link = *(bool *)pos;
 773                 pos += sizeof(if_info->link);
 774
 775                 sysinfo->interfaces[i] = if_info;
 776         }
 777
 778         /* number of interfaces */
 779         if (read_u32(&pos, &len, &sysinfo->n_blockdevs))
 780                 goto out;
 781
 782         sysinfo->blockdevs = talloc_array(sysinfo, struct blockdev_info *,
 783                         sysinfo->n_blockdevs);
 784
 785         for (i = 0; i < sysinfo->n_blockdevs; i++) {
 786                 struct blockdev_info *bd_info = talloc(sysinfo,
 787                                                         struct blockdev_info);
 788
 789                 if (read_string(bd_info, &pos, &len, &bd_info->name))
 790                         goto out;
 791
 792                 if (read_string(bd_info, &pos, &len, &bd_info->uuid))
 793                         goto out;
 794
 795                 if (read_string(bd_info, &pos, &len, &bd_info->mountpoint))
 796                         goto out;
 797
 798                 sysinfo->blockdevs[i] = bd_info;
 799         }
 800         rc = 0;
 801
 802 out:
 803         return rc;
 804 }
 805
 806 static int pb_protocol_deserialise_config_interface(const char **buf,
 807                 unsigned int *len, struct interface_config *iface)
 808 {
 809         unsigned int tmp;
 810
 811         if (*len < sizeof(iface->hwaddr))
 812                 return -1;
 813
 814         memcpy(iface->hwaddr, *buf, sizeof(iface->hwaddr));
 815         *buf += sizeof(iface->hwaddr);
 816         *len -= sizeof(iface->hwaddr);
 817
 818         if (read_u32(buf, len, &tmp))
 819                 return -1;
 820         iface->ignore = !!tmp;
 821
 822         if (iface->ignore)
 823                 return 0;
 824
 825         if (read_u32(buf, len, &iface->method))
 826                 return -1;
 827
 828         if (iface->method == CONFIG_METHOD_STATIC) {
 829                 if (read_string(iface, buf, len, &iface->static_config.address))
 830                         return -1;
 831
 832                 if (read_string(iface, buf, len, &iface->static_config.gateway))
 833                         return -1;
 834         }
 835
 836         return 0;
 837 }
 838
 839 int pb_protocol_deserialise_config(struct config *config,
 840                 const struct pb_protocol_message *message)
 841 {
 842         unsigned int len, i, tmp;
 843         const char *pos;
 844         int rc = -1;
 845
 846         len = message->payload_len;
 847         pos = message->payload;
 848
 849         if (read_u32(&pos, &len, &tmp))
 850                 goto out;
 851         config->autoboot_enabled = !!tmp;
 852
 853         if (read_u32(&pos, &len, &config->autoboot_timeout_sec))
 854                 goto out;
 855
 856         if (read_u32(&pos, &len, &config->network.n_interfaces))
 857                 goto out;
 858
 859         config->network.interfaces = talloc_array(config,
 860                         struct interface_config *, config->network.n_interfaces);
 861
 862         for (i = 0; i < config->network.n_interfaces; i++) {
 863                 struct interface_config *iface = talloc_zero(
 864                                 config->network.interfaces,
 865                                 struct interface_config);
 866                 if (pb_protocol_deserialise_config_interface(&pos, &len, iface))
 867                         goto out;
 868                 config->network.interfaces[i] = iface;
 869         }
 870
 871         if (read_u32(&pos, &len, &config->network.n_dns_servers))
 872                 goto out;
 873         config->network.dns_servers = talloc_array(config, const char *,
 874                         config->network.n_dns_servers);
 875
 876         for (i = 0; i < config->network.n_dns_servers; i++) {
 877                 char *tmp;
 878                 if (read_string(config->network.dns_servers, &pos, &len, &tmp))
 879                         goto out;
 880                 config->network.dns_servers[i] = tmp;
 881         }
 882
 883         if (read_u32(&pos, &len, &config->n_boot_priorities))
 884                 goto out;
 885         config->boot_priorities = talloc_array(config, struct boot_priority,
 886                         config->n_boot_priorities);
 887
 888         for (i = 0; i < config->n_boot_priorities; i++) {
 889                 if (read_u32(&pos, &len, &tmp))
 890                         goto out;
 891                 config->boot_priorities[i].type = tmp;
 892         }
 893
 894         rc = 0;
 895
 896 out:
 897         return rc;
 898 }