Message ID | 1549054223-12220-6-git-send-email-zub@linux.fjfi.cvut.cz (mailing list archive) |
---|---|
State | New, archived |
Headers | show |
Series | block: sed-opal: support shadow MBR done flag and write | expand |
Looks good,
Reviewed-by: Christoph Hellwig <hch@lst.de>
Looks fine with 4/16 Acked-by: Jon Derrick <jonathan.derrick@intel.com> On Fri, 2019-02-01 at 21:50 +0100, David Kozub wrote: > Every step starts with resetting the cmd buffer as well as the comid and > constructs the appropriate OPAL_CALL command. Consequently, those > actions may be combined into one generic function. On should take care > that the opening and closing tokens for the argument list are already > emitted by cmd_start and cmd_finalize respectively and thus must not be > additionally added. > > Co-authored-by: Jonas Rabenstein <jonas.rabenstein@studium.uni-erlangen.de> > Signed-off-by: David Kozub <zub@linux.fjfi.cvut.cz> > Signed-off-by: Jonas Rabenstein <jonas.rabenstein@studium.uni-erlangen.de> > Reviewed-by: Scott Bauer <sbauer@plzdonthack.me> > --- > block/sed-opal.c | 228 ++++++++++++++--------------------------------- > 1 file changed, 69 insertions(+), 159 deletions(-) > > diff --git a/block/sed-opal.c b/block/sed-opal.c > index 35b1747b650f..e29cb2f445ff 100644 > --- a/block/sed-opal.c > +++ b/block/sed-opal.c > @@ -661,7 +661,7 @@ static int cmd_finalize(struct opal_dev *cmd, u32 hsn, u32 tsn) > struct opal_header *hdr; > int err = 0; > > - /* close parameter list */ > + /* close the parameter list opened from cmd_start */ > add_token_u8(&err, cmd, OPAL_ENDLIST); > > add_token_u8(&err, cmd, OPAL_ENDOFDATA); > @@ -1006,6 +1006,27 @@ static void clear_opal_cmd(struct opal_dev *dev) > memset(dev->cmd, 0, IO_BUFFER_LENGTH); > } > > +static int cmd_start(struct opal_dev *dev, const u8 *uid, const u8 *method) > +{ > + int err = 0; > + > + clear_opal_cmd(dev); > + set_comid(dev, dev->comid); > + > + add_token_u8(&err, dev, OPAL_CALL); > + add_token_bytestring(&err, dev, uid, OPAL_UID_LENGTH); > + add_token_bytestring(&err, dev, method, OPAL_METHOD_LENGTH); > + > + /* > + * Every method call is followed by its parameters enclosed within > + * OPAL_STARTLIST and OPAL_ENDLIST tokens. We automatically open the > + * parameter list here and close it later in cmd_finalize. > + */ > + add_token_u8(&err, dev, OPAL_STARTLIST); > + > + return err; > +} > + > static int start_opal_session_cont(struct opal_dev *dev) > { > u32 hsn, tsn; > @@ -1068,20 +1089,13 @@ static int finalize_and_send(struct opal_dev *dev, cont_fn cont) > static int gen_key(struct opal_dev *dev, void *data) > { > u8 uid[OPAL_UID_LENGTH]; > - int err = 0; > - > - clear_opal_cmd(dev); > - set_comid(dev, dev->comid); > + int err; > > memcpy(uid, dev->prev_data, min(sizeof(uid), dev->prev_d_len)); > kfree(dev->prev_data); > dev->prev_data = NULL; > > - add_token_u8(&err, dev, OPAL_CALL); > - add_token_bytestring(&err, dev, uid, OPAL_UID_LENGTH); > - add_token_bytestring(&err, dev, opalmethod[OPAL_GENKEY], > - OPAL_UID_LENGTH); > - add_token_u8(&err, dev, OPAL_STARTLIST); > + err = cmd_start(dev, uid, opalmethod[OPAL_GENKEY]); > > if (err) { > pr_debug("Error building gen key command\n"); > @@ -1119,21 +1133,14 @@ static int get_active_key_cont(struct opal_dev *dev) > static int get_active_key(struct opal_dev *dev, void *data) > { > u8 uid[OPAL_UID_LENGTH]; > - int err = 0; > + int err; > u8 *lr = data; > > - clear_opal_cmd(dev); > - set_comid(dev, dev->comid); > - > err = build_locking_range(uid, sizeof(uid), *lr); > if (err) > return err; > > - err = 0; > - add_token_u8(&err, dev, OPAL_CALL); > - add_token_bytestring(&err, dev, uid, OPAL_UID_LENGTH); > - add_token_bytestring(&err, dev, opalmethod[OPAL_GET], OPAL_UID_LENGTH); > - add_token_u8(&err, dev, OPAL_STARTLIST); > + err = cmd_start(dev, uid, opalmethod[OPAL_GET]); > add_token_u8(&err, dev, OPAL_STARTLIST); > add_token_u8(&err, dev, OPAL_STARTNAME); > add_token_u8(&err, dev, 3); /* startCloumn */ > @@ -1156,13 +1163,10 @@ static int generic_lr_enable_disable(struct opal_dev *dev, > u8 *uid, bool rle, bool wle, > bool rl, bool wl) > { > - int err = 0; > + int err; > > - add_token_u8(&err, dev, OPAL_CALL); > - add_token_bytestring(&err, dev, uid, OPAL_UID_LENGTH); > - add_token_bytestring(&err, dev, opalmethod[OPAL_SET], OPAL_UID_LENGTH); > + err = cmd_start(dev, uid, opalmethod[OPAL_SET]); > > - add_token_u8(&err, dev, OPAL_STARTLIST); > add_token_u8(&err, dev, OPAL_STARTNAME); > add_token_u8(&err, dev, OPAL_VALUES); > add_token_u8(&err, dev, OPAL_STARTLIST); > @@ -1209,10 +1213,7 @@ static int setup_locking_range(struct opal_dev *dev, void *data) > u8 uid[OPAL_UID_LENGTH]; > struct opal_user_lr_setup *setup = data; > u8 lr; > - int err = 0; > - > - clear_opal_cmd(dev); > - set_comid(dev, dev->comid); > + int err; > > lr = setup->session.opal_key.lr; > err = build_locking_range(uid, sizeof(uid), lr); > @@ -1222,12 +1223,8 @@ static int setup_locking_range(struct opal_dev *dev, void *data) > if (lr == 0) > err = enable_global_lr(dev, uid, setup); > else { > - add_token_u8(&err, dev, OPAL_CALL); > - add_token_bytestring(&err, dev, uid, OPAL_UID_LENGTH); > - add_token_bytestring(&err, dev, opalmethod[OPAL_SET], > - OPAL_UID_LENGTH); > + err = cmd_start(dev, uid, opalmethod[OPAL_SET]); > > - add_token_u8(&err, dev, OPAL_STARTLIST); > add_token_u8(&err, dev, OPAL_STARTNAME); > add_token_u8(&err, dev, OPAL_VALUES); > add_token_u8(&err, dev, OPAL_STARTLIST); > @@ -1271,22 +1268,15 @@ static int start_generic_opal_session(struct opal_dev *dev, > u8 key_len) > { > u32 hsn; > - int err = 0; > + int err; > > if (key == NULL && auth != OPAL_ANYBODY_UID) > return OPAL_INVAL_PARAM; > > - clear_opal_cmd(dev); > - > - set_comid(dev, dev->comid); > hsn = GENERIC_HOST_SESSION_NUM; > + err = cmd_start(dev, opaluid[OPAL_SMUID_UID], > + opalmethod[OPAL_STARTSESSION]); > > - add_token_u8(&err, dev, OPAL_CALL); > - add_token_bytestring(&err, dev, opaluid[OPAL_SMUID_UID], > - OPAL_UID_LENGTH); > - add_token_bytestring(&err, dev, opalmethod[OPAL_STARTSESSION], > - OPAL_UID_LENGTH); > - add_token_u8(&err, dev, OPAL_STARTLIST); > add_token_u64(&err, dev, hsn); > add_token_bytestring(&err, dev, opaluid[sp_type], OPAL_UID_LENGTH); > add_token_u8(&err, dev, 1); > @@ -1366,30 +1356,21 @@ static int start_auth_opal_session(struct opal_dev *dev, void *data) > u8 *key = session->opal_key.key; > u32 hsn = GENERIC_HOST_SESSION_NUM; > > - clear_opal_cmd(dev); > - set_comid(dev, dev->comid); > - > - if (session->sum) { > + if (session->sum) > err = build_locking_user(lk_ul_user, sizeof(lk_ul_user), > session->opal_key.lr); > - if (err) > - return err; > - > - } else if (session->who != OPAL_ADMIN1 && !session->sum) { > + else if (session->who != OPAL_ADMIN1 && !session->sum) > err = build_locking_user(lk_ul_user, sizeof(lk_ul_user), > session->who - 1); > - if (err) > - return err; > - } else > + else > memcpy(lk_ul_user, opaluid[OPAL_ADMIN1_UID], OPAL_UID_LENGTH); > > - add_token_u8(&err, dev, OPAL_CALL); > - add_token_bytestring(&err, dev, opaluid[OPAL_SMUID_UID], > - OPAL_UID_LENGTH); > - add_token_bytestring(&err, dev, opalmethod[OPAL_STARTSESSION], > - OPAL_UID_LENGTH); > + if (err) > + return err; > + > + err = cmd_start(dev, opaluid[OPAL_SMUID_UID], > + opalmethod[OPAL_STARTSESSION]); > > - add_token_u8(&err, dev, OPAL_STARTLIST); > add_token_u64(&err, dev, hsn); > add_token_bytestring(&err, dev, opaluid[OPAL_LOCKINGSP_UID], > OPAL_UID_LENGTH); > @@ -1413,17 +1394,10 @@ static int start_auth_opal_session(struct opal_dev *dev, void *data) > > static int revert_tper(struct opal_dev *dev, void *data) > { > - int err = 0; > - > - clear_opal_cmd(dev); > - set_comid(dev, dev->comid); > + int err; > > - add_token_u8(&err, dev, OPAL_CALL); > - add_token_bytestring(&err, dev, opaluid[OPAL_ADMINSP_UID], > - OPAL_UID_LENGTH); > - add_token_bytestring(&err, dev, opalmethod[OPAL_REVERT], > - OPAL_UID_LENGTH); > - add_token_u8(&err, dev, OPAL_STARTLIST); > + err = cmd_start(dev, opaluid[OPAL_ADMINSP_UID], > + opalmethod[OPAL_REVERT]); > if (err) { > pr_debug("Error building REVERT TPER command.\n"); > return err; > @@ -1436,18 +1410,12 @@ static int internal_activate_user(struct opal_dev *dev, void *data) > { > struct opal_session_info *session = data; > u8 uid[OPAL_UID_LENGTH]; > - int err = 0; > - > - clear_opal_cmd(dev); > - set_comid(dev, dev->comid); > + int err; > > memcpy(uid, opaluid[OPAL_USER1_UID], OPAL_UID_LENGTH); > uid[7] = session->who; > > - add_token_u8(&err, dev, OPAL_CALL); > - add_token_bytestring(&err, dev, uid, OPAL_UID_LENGTH); > - add_token_bytestring(&err, dev, opalmethod[OPAL_SET], OPAL_UID_LENGTH); > - add_token_u8(&err, dev, OPAL_STARTLIST); > + err = cmd_start(dev, uid, opalmethod[OPAL_SET]); > add_token_u8(&err, dev, OPAL_STARTNAME); > add_token_u8(&err, dev, OPAL_VALUES); > add_token_u8(&err, dev, OPAL_STARTLIST); > @@ -1470,19 +1438,12 @@ static int erase_locking_range(struct opal_dev *dev, void *data) > { > struct opal_session_info *session = data; > u8 uid[OPAL_UID_LENGTH]; > - int err = 0; > - > - clear_opal_cmd(dev); > - set_comid(dev, dev->comid); > + int err; > > if (build_locking_range(uid, sizeof(uid), session->opal_key.lr) < 0) > return -ERANGE; > > - add_token_u8(&err, dev, OPAL_CALL); > - add_token_bytestring(&err, dev, uid, OPAL_UID_LENGTH); > - add_token_bytestring(&err, dev, opalmethod[OPAL_ERASE], > - OPAL_UID_LENGTH); > - add_token_u8(&err, dev, OPAL_STARTLIST); > + err = cmd_start(dev, uid, opalmethod[OPAL_ERASE]); > > if (err) { > pr_debug("Error building Erase Locking Range Command.\n"); > @@ -1494,16 +1455,11 @@ static int erase_locking_range(struct opal_dev *dev, void *data) > static int set_mbr_done(struct opal_dev *dev, void *data) > { > u8 *mbr_done_tf = data; > - int err = 0; > + int err; > > - clear_opal_cmd(dev); > - set_comid(dev, dev->comid); > + err = cmd_start(dev, opaluid[OPAL_MBRCONTROL], > + opalmethod[OPAL_SET]); > > - add_token_u8(&err, dev, OPAL_CALL); > - add_token_bytestring(&err, dev, opaluid[OPAL_MBRCONTROL], > - OPAL_UID_LENGTH); > - add_token_bytestring(&err, dev, opalmethod[OPAL_SET], OPAL_UID_LENGTH); > - add_token_u8(&err, dev, OPAL_STARTLIST); > add_token_u8(&err, dev, OPAL_STARTNAME); > add_token_u8(&err, dev, OPAL_VALUES); > add_token_u8(&err, dev, OPAL_STARTLIST); > @@ -1525,16 +1481,11 @@ static int set_mbr_done(struct opal_dev *dev, void *data) > static int set_mbr_enable_disable(struct opal_dev *dev, void *data) > { > u8 *mbr_en_dis = data; > - int err = 0; > + int err; > > - clear_opal_cmd(dev); > - set_comid(dev, dev->comid); > + err = cmd_start(dev, opaluid[OPAL_MBRCONTROL], > + opalmethod[OPAL_SET]); > > - add_token_u8(&err, dev, OPAL_CALL); > - add_token_bytestring(&err, dev, opaluid[OPAL_MBRCONTROL], > - OPAL_UID_LENGTH); > - add_token_bytestring(&err, dev, opalmethod[OPAL_SET], OPAL_UID_LENGTH); > - add_token_u8(&err, dev, OPAL_STARTLIST); > add_token_u8(&err, dev, OPAL_STARTNAME); > add_token_u8(&err, dev, OPAL_VALUES); > add_token_u8(&err, dev, OPAL_STARTLIST); > @@ -1556,16 +1507,10 @@ static int set_mbr_enable_disable(struct opal_dev *dev, void *data) > static int generic_pw_cmd(u8 *key, size_t key_len, u8 *cpin_uid, > struct opal_dev *dev) > { > - int err = 0; > + int err; > > - clear_opal_cmd(dev); > - set_comid(dev, dev->comid); > + err = cmd_start(dev, cpin_uid, opalmethod[OPAL_SET]); > > - add_token_u8(&err, dev, OPAL_CALL); > - add_token_bytestring(&err, dev, cpin_uid, OPAL_UID_LENGTH); > - add_token_bytestring(&err, dev, opalmethod[OPAL_SET], > - OPAL_UID_LENGTH); > - add_token_u8(&err, dev, OPAL_STARTLIST); > add_token_u8(&err, dev, OPAL_STARTNAME); > add_token_u8(&err, dev, OPAL_VALUES); > add_token_u8(&err, dev, OPAL_STARTLIST); > @@ -1622,10 +1567,7 @@ static int add_user_to_lr(struct opal_dev *dev, void *data) > u8 lr_buffer[OPAL_UID_LENGTH]; > u8 user_uid[OPAL_UID_LENGTH]; > struct opal_lock_unlock *lkul = data; > - int err = 0; > - > - clear_opal_cmd(dev); > - set_comid(dev, dev->comid); > + int err; > > memcpy(lr_buffer, opaluid[OPAL_LOCKINGRANGE_ACE_RDLOCKED], > OPAL_UID_LENGTH); > @@ -1640,12 +1582,8 @@ static int add_user_to_lr(struct opal_dev *dev, void *data) > > user_uid[7] = lkul->session.who; > > - add_token_u8(&err, dev, OPAL_CALL); > - add_token_bytestring(&err, dev, lr_buffer, OPAL_UID_LENGTH); > - add_token_bytestring(&err, dev, opalmethod[OPAL_SET], > - OPAL_UID_LENGTH); > + err = cmd_start(dev, lr_buffer, opalmethod[OPAL_SET]); > > - add_token_u8(&err, dev, OPAL_STARTLIST); > add_token_u8(&err, dev, OPAL_STARTNAME); > add_token_u8(&err, dev, OPAL_VALUES); > > @@ -1699,9 +1637,6 @@ static int lock_unlock_locking_range(struct opal_dev *dev, void *data) > u8 read_locked = 1, write_locked = 1; > int err = 0; > > - clear_opal_cmd(dev); > - set_comid(dev, dev->comid); > - > if (build_locking_range(lr_buffer, sizeof(lr_buffer), > lkul->session.opal_key.lr) < 0) > return -ERANGE; > @@ -1723,10 +1658,8 @@ static int lock_unlock_locking_range(struct opal_dev *dev, void *data) > return OPAL_INVAL_PARAM; > } > > - add_token_u8(&err, dev, OPAL_CALL); > - add_token_bytestring(&err, dev, lr_buffer, OPAL_UID_LENGTH); > - add_token_bytestring(&err, dev, opalmethod[OPAL_SET], OPAL_UID_LENGTH); > - add_token_u8(&err, dev, OPAL_STARTLIST); > + err = cmd_start(dev, lr_buffer, opalmethod[OPAL_SET]); > + > add_token_u8(&err, dev, OPAL_STARTNAME); > add_token_u8(&err, dev, OPAL_VALUES); > add_token_u8(&err, dev, OPAL_STARTLIST); > @@ -1797,17 +1730,10 @@ static int activate_lsp(struct opal_dev *dev, void *data) > struct opal_lr_act *opal_act = data; > u8 user_lr[OPAL_UID_LENGTH]; > u8 uint_3 = 0x83; > - int err = 0, i; > - > - clear_opal_cmd(dev); > - set_comid(dev, dev->comid); > - > - add_token_u8(&err, dev, OPAL_CALL); > - add_token_bytestring(&err, dev, opaluid[OPAL_LOCKINGSP_UID], > - OPAL_UID_LENGTH); > - add_token_bytestring(&err, dev, opalmethod[OPAL_ACTIVATE], > - OPAL_UID_LENGTH); > + int err, i; > > + err = cmd_start(dev, opaluid[OPAL_LOCKINGSP_UID], > + opalmethod[OPAL_ACTIVATE]); > > if (opal_act->sum) { > err = build_locking_range(user_lr, sizeof(user_lr), > @@ -1815,7 +1741,6 @@ static int activate_lsp(struct opal_dev *dev, void *data) > if (err) > return err; > > - add_token_u8(&err, dev, OPAL_STARTLIST); > add_token_u8(&err, dev, OPAL_STARTNAME); > add_token_u8(&err, dev, uint_3); > add_token_u8(&err, dev, 6); > @@ -1830,8 +1755,6 @@ static int activate_lsp(struct opal_dev *dev, void *data) > } > add_token_u8(&err, dev, OPAL_ENDLIST); > add_token_u8(&err, dev, OPAL_ENDNAME); > - } else { > - add_token_u8(&err, dev, OPAL_STARTLIST); > } > > if (err) { > @@ -1865,17 +1788,11 @@ static int get_lsp_lifecycle_cont(struct opal_dev *dev) > /* Determine if we're in the Manufactured Inactive or Active state */ > static int get_lsp_lifecycle(struct opal_dev *dev, void *data) > { > - int err = 0; > - > - clear_opal_cmd(dev); > - set_comid(dev, dev->comid); > + int err; > > - add_token_u8(&err, dev, OPAL_CALL); > - add_token_bytestring(&err, dev, opaluid[OPAL_LOCKINGSP_UID], > - OPAL_UID_LENGTH); > - add_token_bytestring(&err, dev, opalmethod[OPAL_GET], OPAL_UID_LENGTH); > + err = cmd_start(dev, opaluid[OPAL_LOCKINGSP_UID], > + opalmethod[OPAL_GET]); > > - add_token_u8(&err, dev, OPAL_STARTLIST); > add_token_u8(&err, dev, OPAL_STARTLIST); > > add_token_u8(&err, dev, OPAL_STARTNAME); > @@ -1925,19 +1842,12 @@ static int get_msid_cpin_pin_cont(struct opal_dev *dev) > > static int get_msid_cpin_pin(struct opal_dev *dev, void *data) > { > - int err = 0; > - > - clear_opal_cmd(dev); > - set_comid(dev, dev->comid); > + int err; > > - add_token_u8(&err, dev, OPAL_CALL); > - add_token_bytestring(&err, dev, opaluid[OPAL_C_PIN_MSID], > - OPAL_UID_LENGTH); > - add_token_bytestring(&err, dev, opalmethod[OPAL_GET], OPAL_UID_LENGTH); > + err = cmd_start(dev, opaluid[OPAL_C_PIN_MSID], > + opalmethod[OPAL_GET]); > > add_token_u8(&err, dev, OPAL_STARTLIST); > - add_token_u8(&err, dev, OPAL_STARTLIST); > - > add_token_u8(&err, dev, OPAL_STARTNAME); > add_token_u8(&err, dev, 3); /* Start Column */ > add_token_u8(&err, dev, 3); /* PIN */
diff --git a/block/sed-opal.c b/block/sed-opal.c index 35b1747b650f..e29cb2f445ff 100644 --- a/block/sed-opal.c +++ b/block/sed-opal.c @@ -661,7 +661,7 @@ static int cmd_finalize(struct opal_dev *cmd, u32 hsn, u32 tsn) struct opal_header *hdr; int err = 0; - /* close parameter list */ + /* close the parameter list opened from cmd_start */ add_token_u8(&err, cmd, OPAL_ENDLIST); add_token_u8(&err, cmd, OPAL_ENDOFDATA); @@ -1006,6 +1006,27 @@ static void clear_opal_cmd(struct opal_dev *dev) memset(dev->cmd, 0, IO_BUFFER_LENGTH); } +static int cmd_start(struct opal_dev *dev, const u8 *uid, const u8 *method) +{ + int err = 0; + + clear_opal_cmd(dev); + set_comid(dev, dev->comid); + + add_token_u8(&err, dev, OPAL_CALL); + add_token_bytestring(&err, dev, uid, OPAL_UID_LENGTH); + add_token_bytestring(&err, dev, method, OPAL_METHOD_LENGTH); + + /* + * Every method call is followed by its parameters enclosed within + * OPAL_STARTLIST and OPAL_ENDLIST tokens. We automatically open the + * parameter list here and close it later in cmd_finalize. + */ + add_token_u8(&err, dev, OPAL_STARTLIST); + + return err; +} + static int start_opal_session_cont(struct opal_dev *dev) { u32 hsn, tsn; @@ -1068,20 +1089,13 @@ static int finalize_and_send(struct opal_dev *dev, cont_fn cont) static int gen_key(struct opal_dev *dev, void *data) { u8 uid[OPAL_UID_LENGTH]; - int err = 0; - - clear_opal_cmd(dev); - set_comid(dev, dev->comid); + int err; memcpy(uid, dev->prev_data, min(sizeof(uid), dev->prev_d_len)); kfree(dev->prev_data); dev->prev_data = NULL; - add_token_u8(&err, dev, OPAL_CALL); - add_token_bytestring(&err, dev, uid, OPAL_UID_LENGTH); - add_token_bytestring(&err, dev, opalmethod[OPAL_GENKEY], - OPAL_UID_LENGTH); - add_token_u8(&err, dev, OPAL_STARTLIST); + err = cmd_start(dev, uid, opalmethod[OPAL_GENKEY]); if (err) { pr_debug("Error building gen key command\n"); @@ -1119,21 +1133,14 @@ static int get_active_key_cont(struct opal_dev *dev) static int get_active_key(struct opal_dev *dev, void *data) { u8 uid[OPAL_UID_LENGTH]; - int err = 0; + int err; u8 *lr = data; - clear_opal_cmd(dev); - set_comid(dev, dev->comid); - err = build_locking_range(uid, sizeof(uid), *lr); if (err) return err; - err = 0; - add_token_u8(&err, dev, OPAL_CALL); - add_token_bytestring(&err, dev, uid, OPAL_UID_LENGTH); - add_token_bytestring(&err, dev, opalmethod[OPAL_GET], OPAL_UID_LENGTH); - add_token_u8(&err, dev, OPAL_STARTLIST); + err = cmd_start(dev, uid, opalmethod[OPAL_GET]); add_token_u8(&err, dev, OPAL_STARTLIST); add_token_u8(&err, dev, OPAL_STARTNAME); add_token_u8(&err, dev, 3); /* startCloumn */ @@ -1156,13 +1163,10 @@ static int generic_lr_enable_disable(struct opal_dev *dev, u8 *uid, bool rle, bool wle, bool rl, bool wl) { - int err = 0; + int err; - add_token_u8(&err, dev, OPAL_CALL); - add_token_bytestring(&err, dev, uid, OPAL_UID_LENGTH); - add_token_bytestring(&err, dev, opalmethod[OPAL_SET], OPAL_UID_LENGTH); + err = cmd_start(dev, uid, opalmethod[OPAL_SET]); - add_token_u8(&err, dev, OPAL_STARTLIST); add_token_u8(&err, dev, OPAL_STARTNAME); add_token_u8(&err, dev, OPAL_VALUES); add_token_u8(&err, dev, OPAL_STARTLIST); @@ -1209,10 +1213,7 @@ static int setup_locking_range(struct opal_dev *dev, void *data) u8 uid[OPAL_UID_LENGTH]; struct opal_user_lr_setup *setup = data; u8 lr; - int err = 0; - - clear_opal_cmd(dev); - set_comid(dev, dev->comid); + int err; lr = setup->session.opal_key.lr; err = build_locking_range(uid, sizeof(uid), lr); @@ -1222,12 +1223,8 @@ static int setup_locking_range(struct opal_dev *dev, void *data) if (lr == 0) err = enable_global_lr(dev, uid, setup); else { - add_token_u8(&err, dev, OPAL_CALL); - add_token_bytestring(&err, dev, uid, OPAL_UID_LENGTH); - add_token_bytestring(&err, dev, opalmethod[OPAL_SET], - OPAL_UID_LENGTH); + err = cmd_start(dev, uid, opalmethod[OPAL_SET]); - add_token_u8(&err, dev, OPAL_STARTLIST); add_token_u8(&err, dev, OPAL_STARTNAME); add_token_u8(&err, dev, OPAL_VALUES); add_token_u8(&err, dev, OPAL_STARTLIST); @@ -1271,22 +1268,15 @@ static int start_generic_opal_session(struct opal_dev *dev, u8 key_len) { u32 hsn; - int err = 0; + int err; if (key == NULL && auth != OPAL_ANYBODY_UID) return OPAL_INVAL_PARAM; - clear_opal_cmd(dev); - - set_comid(dev, dev->comid); hsn = GENERIC_HOST_SESSION_NUM; + err = cmd_start(dev, opaluid[OPAL_SMUID_UID], + opalmethod[OPAL_STARTSESSION]); - add_token_u8(&err, dev, OPAL_CALL); - add_token_bytestring(&err, dev, opaluid[OPAL_SMUID_UID], - OPAL_UID_LENGTH); - add_token_bytestring(&err, dev, opalmethod[OPAL_STARTSESSION], - OPAL_UID_LENGTH); - add_token_u8(&err, dev, OPAL_STARTLIST); add_token_u64(&err, dev, hsn); add_token_bytestring(&err, dev, opaluid[sp_type], OPAL_UID_LENGTH); add_token_u8(&err, dev, 1); @@ -1366,30 +1356,21 @@ static int start_auth_opal_session(struct opal_dev *dev, void *data) u8 *key = session->opal_key.key; u32 hsn = GENERIC_HOST_SESSION_NUM; - clear_opal_cmd(dev); - set_comid(dev, dev->comid); - - if (session->sum) { + if (session->sum) err = build_locking_user(lk_ul_user, sizeof(lk_ul_user), session->opal_key.lr); - if (err) - return err; - - } else if (session->who != OPAL_ADMIN1 && !session->sum) { + else if (session->who != OPAL_ADMIN1 && !session->sum) err = build_locking_user(lk_ul_user, sizeof(lk_ul_user), session->who - 1); - if (err) - return err; - } else + else memcpy(lk_ul_user, opaluid[OPAL_ADMIN1_UID], OPAL_UID_LENGTH); - add_token_u8(&err, dev, OPAL_CALL); - add_token_bytestring(&err, dev, opaluid[OPAL_SMUID_UID], - OPAL_UID_LENGTH); - add_token_bytestring(&err, dev, opalmethod[OPAL_STARTSESSION], - OPAL_UID_LENGTH); + if (err) + return err; + + err = cmd_start(dev, opaluid[OPAL_SMUID_UID], + opalmethod[OPAL_STARTSESSION]); - add_token_u8(&err, dev, OPAL_STARTLIST); add_token_u64(&err, dev, hsn); add_token_bytestring(&err, dev, opaluid[OPAL_LOCKINGSP_UID], OPAL_UID_LENGTH); @@ -1413,17 +1394,10 @@ static int start_auth_opal_session(struct opal_dev *dev, void *data) static int revert_tper(struct opal_dev *dev, void *data) { - int err = 0; - - clear_opal_cmd(dev); - set_comid(dev, dev->comid); + int err; - add_token_u8(&err, dev, OPAL_CALL); - add_token_bytestring(&err, dev, opaluid[OPAL_ADMINSP_UID], - OPAL_UID_LENGTH); - add_token_bytestring(&err, dev, opalmethod[OPAL_REVERT], - OPAL_UID_LENGTH); - add_token_u8(&err, dev, OPAL_STARTLIST); + err = cmd_start(dev, opaluid[OPAL_ADMINSP_UID], + opalmethod[OPAL_REVERT]); if (err) { pr_debug("Error building REVERT TPER command.\n"); return err; @@ -1436,18 +1410,12 @@ static int internal_activate_user(struct opal_dev *dev, void *data) { struct opal_session_info *session = data; u8 uid[OPAL_UID_LENGTH]; - int err = 0; - - clear_opal_cmd(dev); - set_comid(dev, dev->comid); + int err; memcpy(uid, opaluid[OPAL_USER1_UID], OPAL_UID_LENGTH); uid[7] = session->who; - add_token_u8(&err, dev, OPAL_CALL); - add_token_bytestring(&err, dev, uid, OPAL_UID_LENGTH); - add_token_bytestring(&err, dev, opalmethod[OPAL_SET], OPAL_UID_LENGTH); - add_token_u8(&err, dev, OPAL_STARTLIST); + err = cmd_start(dev, uid, opalmethod[OPAL_SET]); add_token_u8(&err, dev, OPAL_STARTNAME); add_token_u8(&err, dev, OPAL_VALUES); add_token_u8(&err, dev, OPAL_STARTLIST); @@ -1470,19 +1438,12 @@ static int erase_locking_range(struct opal_dev *dev, void *data) { struct opal_session_info *session = data; u8 uid[OPAL_UID_LENGTH]; - int err = 0; - - clear_opal_cmd(dev); - set_comid(dev, dev->comid); + int err; if (build_locking_range(uid, sizeof(uid), session->opal_key.lr) < 0) return -ERANGE; - add_token_u8(&err, dev, OPAL_CALL); - add_token_bytestring(&err, dev, uid, OPAL_UID_LENGTH); - add_token_bytestring(&err, dev, opalmethod[OPAL_ERASE], - OPAL_UID_LENGTH); - add_token_u8(&err, dev, OPAL_STARTLIST); + err = cmd_start(dev, uid, opalmethod[OPAL_ERASE]); if (err) { pr_debug("Error building Erase Locking Range Command.\n"); @@ -1494,16 +1455,11 @@ static int erase_locking_range(struct opal_dev *dev, void *data) static int set_mbr_done(struct opal_dev *dev, void *data) { u8 *mbr_done_tf = data; - int err = 0; + int err; - clear_opal_cmd(dev); - set_comid(dev, dev->comid); + err = cmd_start(dev, opaluid[OPAL_MBRCONTROL], + opalmethod[OPAL_SET]); - add_token_u8(&err, dev, OPAL_CALL); - add_token_bytestring(&err, dev, opaluid[OPAL_MBRCONTROL], - OPAL_UID_LENGTH); - add_token_bytestring(&err, dev, opalmethod[OPAL_SET], OPAL_UID_LENGTH); - add_token_u8(&err, dev, OPAL_STARTLIST); add_token_u8(&err, dev, OPAL_STARTNAME); add_token_u8(&err, dev, OPAL_VALUES); add_token_u8(&err, dev, OPAL_STARTLIST); @@ -1525,16 +1481,11 @@ static int set_mbr_done(struct opal_dev *dev, void *data) static int set_mbr_enable_disable(struct opal_dev *dev, void *data) { u8 *mbr_en_dis = data; - int err = 0; + int err; - clear_opal_cmd(dev); - set_comid(dev, dev->comid); + err = cmd_start(dev, opaluid[OPAL_MBRCONTROL], + opalmethod[OPAL_SET]); - add_token_u8(&err, dev, OPAL_CALL); - add_token_bytestring(&err, dev, opaluid[OPAL_MBRCONTROL], - OPAL_UID_LENGTH); - add_token_bytestring(&err, dev, opalmethod[OPAL_SET], OPAL_UID_LENGTH); - add_token_u8(&err, dev, OPAL_STARTLIST); add_token_u8(&err, dev, OPAL_STARTNAME); add_token_u8(&err, dev, OPAL_VALUES); add_token_u8(&err, dev, OPAL_STARTLIST); @@ -1556,16 +1507,10 @@ static int set_mbr_enable_disable(struct opal_dev *dev, void *data) static int generic_pw_cmd(u8 *key, size_t key_len, u8 *cpin_uid, struct opal_dev *dev) { - int err = 0; + int err; - clear_opal_cmd(dev); - set_comid(dev, dev->comid); + err = cmd_start(dev, cpin_uid, opalmethod[OPAL_SET]); - add_token_u8(&err, dev, OPAL_CALL); - add_token_bytestring(&err, dev, cpin_uid, OPAL_UID_LENGTH); - add_token_bytestring(&err, dev, opalmethod[OPAL_SET], - OPAL_UID_LENGTH); - add_token_u8(&err, dev, OPAL_STARTLIST); add_token_u8(&err, dev, OPAL_STARTNAME); add_token_u8(&err, dev, OPAL_VALUES); add_token_u8(&err, dev, OPAL_STARTLIST); @@ -1622,10 +1567,7 @@ static int add_user_to_lr(struct opal_dev *dev, void *data) u8 lr_buffer[OPAL_UID_LENGTH]; u8 user_uid[OPAL_UID_LENGTH]; struct opal_lock_unlock *lkul = data; - int err = 0; - - clear_opal_cmd(dev); - set_comid(dev, dev->comid); + int err; memcpy(lr_buffer, opaluid[OPAL_LOCKINGRANGE_ACE_RDLOCKED], OPAL_UID_LENGTH); @@ -1640,12 +1582,8 @@ static int add_user_to_lr(struct opal_dev *dev, void *data) user_uid[7] = lkul->session.who; - add_token_u8(&err, dev, OPAL_CALL); - add_token_bytestring(&err, dev, lr_buffer, OPAL_UID_LENGTH); - add_token_bytestring(&err, dev, opalmethod[OPAL_SET], - OPAL_UID_LENGTH); + err = cmd_start(dev, lr_buffer, opalmethod[OPAL_SET]); - add_token_u8(&err, dev, OPAL_STARTLIST); add_token_u8(&err, dev, OPAL_STARTNAME); add_token_u8(&err, dev, OPAL_VALUES); @@ -1699,9 +1637,6 @@ static int lock_unlock_locking_range(struct opal_dev *dev, void *data) u8 read_locked = 1, write_locked = 1; int err = 0; - clear_opal_cmd(dev); - set_comid(dev, dev->comid); - if (build_locking_range(lr_buffer, sizeof(lr_buffer), lkul->session.opal_key.lr) < 0) return -ERANGE; @@ -1723,10 +1658,8 @@ static int lock_unlock_locking_range(struct opal_dev *dev, void *data) return OPAL_INVAL_PARAM; } - add_token_u8(&err, dev, OPAL_CALL); - add_token_bytestring(&err, dev, lr_buffer, OPAL_UID_LENGTH); - add_token_bytestring(&err, dev, opalmethod[OPAL_SET], OPAL_UID_LENGTH); - add_token_u8(&err, dev, OPAL_STARTLIST); + err = cmd_start(dev, lr_buffer, opalmethod[OPAL_SET]); + add_token_u8(&err, dev, OPAL_STARTNAME); add_token_u8(&err, dev, OPAL_VALUES); add_token_u8(&err, dev, OPAL_STARTLIST); @@ -1797,17 +1730,10 @@ static int activate_lsp(struct opal_dev *dev, void *data) struct opal_lr_act *opal_act = data; u8 user_lr[OPAL_UID_LENGTH]; u8 uint_3 = 0x83; - int err = 0, i; - - clear_opal_cmd(dev); - set_comid(dev, dev->comid); - - add_token_u8(&err, dev, OPAL_CALL); - add_token_bytestring(&err, dev, opaluid[OPAL_LOCKINGSP_UID], - OPAL_UID_LENGTH); - add_token_bytestring(&err, dev, opalmethod[OPAL_ACTIVATE], - OPAL_UID_LENGTH); + int err, i; + err = cmd_start(dev, opaluid[OPAL_LOCKINGSP_UID], + opalmethod[OPAL_ACTIVATE]); if (opal_act->sum) { err = build_locking_range(user_lr, sizeof(user_lr), @@ -1815,7 +1741,6 @@ static int activate_lsp(struct opal_dev *dev, void *data) if (err) return err; - add_token_u8(&err, dev, OPAL_STARTLIST); add_token_u8(&err, dev, OPAL_STARTNAME); add_token_u8(&err, dev, uint_3); add_token_u8(&err, dev, 6); @@ -1830,8 +1755,6 @@ static int activate_lsp(struct opal_dev *dev, void *data) } add_token_u8(&err, dev, OPAL_ENDLIST); add_token_u8(&err, dev, OPAL_ENDNAME); - } else { - add_token_u8(&err, dev, OPAL_STARTLIST); } if (err) { @@ -1865,17 +1788,11 @@ static int get_lsp_lifecycle_cont(struct opal_dev *dev) /* Determine if we're in the Manufactured Inactive or Active state */ static int get_lsp_lifecycle(struct opal_dev *dev, void *data) { - int err = 0; - - clear_opal_cmd(dev); - set_comid(dev, dev->comid); + int err; - add_token_u8(&err, dev, OPAL_CALL); - add_token_bytestring(&err, dev, opaluid[OPAL_LOCKINGSP_UID], - OPAL_UID_LENGTH); - add_token_bytestring(&err, dev, opalmethod[OPAL_GET], OPAL_UID_LENGTH); + err = cmd_start(dev, opaluid[OPAL_LOCKINGSP_UID], + opalmethod[OPAL_GET]); - add_token_u8(&err, dev, OPAL_STARTLIST); add_token_u8(&err, dev, OPAL_STARTLIST); add_token_u8(&err, dev, OPAL_STARTNAME); @@ -1925,19 +1842,12 @@ static int get_msid_cpin_pin_cont(struct opal_dev *dev) static int get_msid_cpin_pin(struct opal_dev *dev, void *data) { - int err = 0; - - clear_opal_cmd(dev); - set_comid(dev, dev->comid); + int err; - add_token_u8(&err, dev, OPAL_CALL); - add_token_bytestring(&err, dev, opaluid[OPAL_C_PIN_MSID], - OPAL_UID_LENGTH); - add_token_bytestring(&err, dev, opalmethod[OPAL_GET], OPAL_UID_LENGTH); + err = cmd_start(dev, opaluid[OPAL_C_PIN_MSID], + opalmethod[OPAL_GET]); add_token_u8(&err, dev, OPAL_STARTLIST); - add_token_u8(&err, dev, OPAL_STARTLIST); - add_token_u8(&err, dev, OPAL_STARTNAME); add_token_u8(&err, dev, 3); /* Start Column */ add_token_u8(&err, dev, 3); /* PIN */