add_token_u8(err, cmd, number >> (len * 8));
 }
 
-static void add_token_bytestring(int *err, struct opal_dev *cmd,
-                                const u8 *bytestring, size_t len)
+static u8 *add_bytestring_header(int *err, struct opal_dev *cmd, size_t len)
 {
        size_t header_len = 1;
        bool is_short_atom = true;
 
-       if (*err)
-               return;
-
        if (len & ~SHORT_ATOM_LEN_MASK) {
                header_len = 2;
                is_short_atom = false;
 
        if (!can_add(err, cmd, header_len + len)) {
                pr_debug("Error adding bytestring: end of buffer.\n");
-               return;
+               return NULL;
        }
 
        if (is_short_atom)
        else
                add_medium_atom_header(cmd, true, false, len);
 
-       memcpy(&cmd->cmd[cmd->pos], bytestring, len);
-       cmd->pos += len;
+       return &cmd->cmd[cmd->pos];
+}
 
+static void add_token_bytestring(int *err, struct opal_dev *cmd,
+                                const u8 *bytestring, size_t len)
+{
+       u8 *start;
+
+       start = add_bytestring_header(err, cmd, len);
+       if (!start)
+               return;
+       memcpy(start, bytestring, len);
+       cmd->pos += len;
 }
 
 static int build_locking_range(u8 *buffer, size_t length, u8 lr)