Looks fine with 4/16
Acked-by: Jon Derrick <jonathan.derrick@xxxxxxxxx>
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@xxxxxxxxxxxxxxxxxxxxxxx>
> Signed-off-by: David Kozub <zub@xxxxxxxxxxxxxxxxxx>
> Signed-off-by: Jonas Rabenstein <jonas.rabenstein@xxxxxxxxxxxxxxxxxxxxxxx>
> Reviewed-by: Scott Bauer <sbauer@xxxxxxxxxxxxxx>
> ---
> 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 */Attachment:
smime.p7s
Description: S/MIME cryptographic signature
