types: Add device_type to struct device

[petitboot] / lib / pb-protocol / pb-protocol.c

diff --git a/lib/pb-protocol/pb-protocol.c b/lib/pb-protocol/pb-protocol.c
index ded35eb5a1f5888b01374ac028fe9af2d68f2d0b..681b250e20135ee334c0822a500eae0ea50f2973 100644 (file)
--- a/lib/pb-protocol/pb-protocol.c
+++ b/lib/pb-protocol/pb-protocol.c
@@ -2,6 +2,7 @@
 #include <assert.h>
 #include <errno.h>
 #include <string.h>
+#include <stdbool.h>
 #include <stdint.h>
 #include <asm/byteorder.h>
 
@@ -21,6 +22,7 @@
  * action = 0x1: device add message
  *  payload:
  *   4-byte len, id
+ *   1-byte type
  *   4-byte len, name
  *   4-byte len, description
  *   4-byte len, icon_file
@@ -33,6 +35,7 @@
  *    4-byte len, icon_file
  *    4-byte len, boot_image_file
  *    4-byte len, initrd_file
+ *    4-byte len, dtb_file
  *    4-byte len, boot_args
  *
  * action = 0x2: device remove message
@@ -44,6 +47,7 @@
  *   4-byte len, boot option id
  *   4-byte len, boot_image_file
  *   4-byte len, initrd_file
+ *   4-byte len, dtb_file
  *   4-byte len, boot_args
  *
  */
@@ -66,6 +70,7 @@ void pb_protocol_dump_device(const struct device *dev, const char *text,
                fprintf(stream, "%s\t\ticon: %s\n", text, opt->icon_file);
                fprintf(stream, "%s\t\tboot: %s\n", text, opt->boot_image_file);
                fprintf(stream, "%s\t\tinit: %s\n", text, opt->initrd_file);
+               fprintf(stream, "%s\t\tdtb:  %s\n", text, opt->dtb_file);
                fprintf(stream, "%s\t\targs: %s\n", text, opt->boot_args);
        }
 }
@@ -162,6 +167,7 @@ static int optional_strlen(const char *str)
 int pb_protocol_device_len(const struct device *dev)
 {
        return  4 + optional_strlen(dev->id) +
+               sizeof(dev->type) +
                4 + optional_strlen(dev->name) +
                4 + optional_strlen(dev->description) +
                4 + optional_strlen(dev->icon_file);
@@ -177,7 +183,9 @@ int pb_protocol_boot_option_len(const struct boot_option *opt)
                4 + optional_strlen(opt->icon_file) +
                4 + optional_strlen(opt->boot_image_file) +
                4 + optional_strlen(opt->initrd_file) +
-               4 + optional_strlen(opt->boot_args);
+               4 + optional_strlen(opt->dtb_file) +
+               4 + optional_strlen(opt->boot_args) +
+               sizeof(opt->is_default);
 }
 
 int pb_protocol_boot_len(const struct boot_command *boot)
@@ -185,15 +193,26 @@ int pb_protocol_boot_len(const struct boot_command *boot)
        return  4 + optional_strlen(boot->option_id) +
                4 + optional_strlen(boot->boot_image_file) +
                4 + optional_strlen(boot->initrd_file) +
+               4 + optional_strlen(boot->dtb_file) +
                4 + optional_strlen(boot->boot_args);
 }
 
+int pb_protocol_boot_status_len(const struct boot_status *status)
+{
+       return  4 +
+               4 + optional_strlen(status->message) +
+               4 + optional_strlen(status->detail) +
+               4;
+}
+
 int pb_protocol_serialise_device(const struct device *dev,
                char *buf, int buf_len)
 {
        char *pos = buf;
 
        pos += pb_protocol_serialise_string(pos, dev->id);
+       *(enum device_type *)pos = dev->type;
+       pos += sizeof(enum device_type);
        pos += pb_protocol_serialise_string(pos, dev->name);
        pos += pb_protocol_serialise_string(pos, dev->description);
        pos += pb_protocol_serialise_string(pos, dev->icon_file);
@@ -216,8 +235,12 @@ int pb_protocol_serialise_boot_option(const struct boot_option *opt,
        pos += pb_protocol_serialise_string(pos, opt->icon_file);
        pos += pb_protocol_serialise_string(pos, opt->boot_image_file);
        pos += pb_protocol_serialise_string(pos, opt->initrd_file);
+       pos += pb_protocol_serialise_string(pos, opt->dtb_file);
        pos += pb_protocol_serialise_string(pos, opt->boot_args);
 
+       *(bool *)pos = opt->is_default;
+       pos += sizeof(bool);
+
        assert(pos <= buf + buf_len);
        (void)buf_len;
 
@@ -232,6 +255,7 @@ int pb_protocol_serialise_boot_command(const struct boot_command *boot,
        pos += pb_protocol_serialise_string(pos, boot->option_id);
        pos += pb_protocol_serialise_string(pos, boot->boot_image_file);
        pos += pb_protocol_serialise_string(pos, boot->initrd_file);
+       pos += pb_protocol_serialise_string(pos, boot->dtb_file);
        pos += pb_protocol_serialise_string(pos, boot->boot_args);
 
        assert(pos <= buf + buf_len);
@@ -240,6 +264,26 @@ int pb_protocol_serialise_boot_command(const struct boot_command *boot,
        return 0;
 }
 
+int pb_protocol_serialise_boot_status(const struct boot_status *status,
+               char *buf, int buf_len)
+{
+       char *pos = buf;
+
+       *(uint32_t *)pos = __cpu_to_be32(status->type);
+       pos += sizeof(uint32_t);
+
+       pos += pb_protocol_serialise_string(pos, status->message);
+       pos += pb_protocol_serialise_string(pos, status->detail);
+
+       *(uint32_t *)pos = __cpu_to_be32(status->type);
+       pos += sizeof(uint32_t);
+
+       assert(pos <= buf + buf_len);
+       (void)buf_len;
+
+       return 0;
+}
+
 int pb_protocol_write_message(int fd, struct pb_protocol_message *message)
 {
        int total_len, rc;
@@ -344,6 +388,12 @@ int pb_protocol_deserialise_device(struct device *dev,
        if (read_string(dev, &pos, &len, &dev->id))
                goto out;
 
+       if (len < sizeof(enum device_type))
+               goto out;
+       dev->type = *(enum device_type *)(pos);
+       pos += sizeof(enum device_type);
+       len -= sizeof(enum device_type);
+
        if (read_string(dev, &pos, &len, &dev->name))
                goto out;
 
@@ -390,9 +440,16 @@ int pb_protocol_deserialise_boot_option(struct boot_option *opt,
        if (read_string(opt, &pos, &len, &opt->initrd_file))
                goto out;
 
+       if (read_string(opt, &pos, &len, &opt->dtb_file))
+               goto out;
+
        if (read_string(opt, &pos, &len, &opt->boot_args))
                goto out;
 
+       if (len < sizeof(bool))
+               goto out;
+       opt->is_default = *(bool *)(pos);
+
        rc = 0;
 
 out:
@@ -418,6 +475,9 @@ int pb_protocol_deserialise_boot_command(struct boot_command *cmd,
        if (read_string(cmd, &pos, &len, &cmd->initrd_file))
                goto out;
 
+       if (read_string(cmd, &pos, &len, &cmd->dtb_file))
+               goto out;
+
        if (read_string(cmd, &pos, &len, &cmd->boot_args))
                goto out;
 
@@ -426,3 +486,53 @@ int pb_protocol_deserialise_boot_command(struct boot_command *cmd,
 out:
        return rc;
 }
+
+int pb_protocol_deserialise_boot_status(struct boot_status *status,
+               const struct pb_protocol_message *message)
+{
+       unsigned int len;
+       const char *pos;
+       int rc = -1;
+
+       len = message->payload_len;
+       pos = message->payload;
+
+       /* first up, the type enum... */
+       if (len < sizeof(uint32_t))
+               goto out;
+
+       status->type = __be32_to_cpu(*(uint32_t *)(pos));
+
+       switch (status->type) {
+       case BOOT_STATUS_ERROR:
+       case BOOT_STATUS_INFO:
+               break;
+       default:
+               goto out;
+       }
+
+       pos += sizeof(uint32_t);
+       len -= sizeof(uint32_t);
+
+       /* message and detail strings */
+       if (read_string(status, &pos, &len, &status->message))
+               goto out;
+
+       if (read_string(status, &pos, &len, &status->detail))
+               goto out;
+
+       /* and finally, progress */
+       if (len < sizeof(uint32_t))
+               goto out;
+
+       status->progress = __be32_to_cpu(*(uint32_t *)(pos));
+
+       /* clamp to 100% */
+       if (status->progress > 100)
+               status->progress = 100;
+
+       rc = 0;
+
+out:
+       return rc;
+}