/* Return of 0 -> success, otherwise see sg_ll_send_diag() */
static int do_senddiag(int sg_fd, int sf_code, int pf_bit, int sf_bit,
int devofl_bit, int unitofl_bit, void * outgoing_pg,
int outgoing_len, int noisy, int verbose)
{
int long_duration = 0;
if ((0 == sf_bit) && ((5 == sf_code) || (6 == sf_code)))
long_duration = 1; /* foreground self-tests */
return sg_ll_send_diag(sg_fd, sf_code, pf_bit, sf_bit, devofl_bit,
unitofl_bit, long_duration, outgoing_pg,
outgoing_len, noisy, verbose);
}
static int
send_then_receive(int sg_fd, uint32_t gen_code, int off_off,
const uint8_t * dmp, int dmp_len,
struct dout_buff_t * wp, uint8_t * dip,
int din_len, bool last, const struct opts_t * op)
{
bool send_data = false;
int do_len, rem, res, rsp_len, k, n, num, mc_status, resid, act_len, verb;
int ret = 0;
uint32_t rec_gen_code;
const uint8_t * bp;
const char * cp;
verb = (op->verbose > 1) ? op->verbose - 1 : 0;
switch (op->mc_mode) {
case MODE_DNLD_MC_OFFS:
case MODE_DNLD_MC_OFFS_SAVE:
case MODE_DNLD_MC_OFFS_DEFER:
send_data = true;
do_len = 24 + dmp_len;
rem = do_len % 4;
if (rem)
do_len += (4 - rem);
break;
case MODE_ACTIVATE_MC:
case MODE_ABORT_MC:
do_len = 24;
break;
default:
pr2serr("%s: unexpected mc_mode=0x%x\n", __func__, op->mc_mode);
return SG_LIB_SYNTAX_ERROR;
}
if (do_len > wp->dout_len) {
if (wp->doutp)
free(wp->doutp);
wp->doutp = sg_memalign(do_len, 0, &wp->free_doutp, op->verbose > 3);
if (! wp->doutp) {
pr2serr("%s: unable to alloc %d bytes\n", __func__, do_len);
return SG_LIB_CAT_OTHER;
}
wp->dout_len = do_len;
} else
memset(wp->doutp, 0, do_len);
wp->doutp[0] = DPC_DOWNLOAD_MICROCODE;
wp->doutp[1] = op->mc_subenc;
sg_put_unaligned_be16(do_len - 4, wp->doutp + 2);
sg_put_unaligned_be32(gen_code, wp->doutp + 4);
wp->doutp[8] = op->mc_mode;
wp->doutp[11] = op->mc_id;
if (send_data)
sg_put_unaligned_be32(op->mc_offset + off_off, wp->doutp + 12);
sg_put_unaligned_be32(op->mc_tlen, wp->doutp + 16);
sg_put_unaligned_be32(dmp_len, wp->doutp + 20);
if (send_data && (dmp_len > 0))
memcpy(wp->doutp + 24, dmp, dmp_len);
if ((op->verbose > 2) || (op->dry_run && op->verbose)) {
pr2serr("send diag: sub-enc id=%u exp_gen=%u download_mc_code=%u "
"buff_id=%u\n", op->mc_subenc, gen_code, op->mc_mode,
op->mc_id);
pr2serr(" buff_off=%u image_len=%u this_mc_data_len=%u "
"dout_len=%u\n", op->mc_offset + off_off, op->mc_tlen,
dmp_len, do_len);
}
/* select long duration timeout (7200 seconds) */
if (op->dry_run) {
if (op->mc_subenc < 4) {
int s = op->mc_offset + off_off + dmp_len;
n = 8 + (op->mc_subenc * 16);
dummy_rd_resp[n + 11] = op->mc_id;
sg_put_unaligned_be32(((send_data && (! last)) ? s : 0),
dummy_rd_resp + n + 12);
if (MODE_ABORT_MC == op->mc_mode)
dummy_rd_resp[n + 2] = 0x80;
else if (MODE_ACTIVATE_MC == op->mc_mode)
dummy_rd_resp[n + 2] = 0x0; /* done */
else
dummy_rd_resp[n + 2] = (s >= op->mc_tlen) ? 0x13 : 0x1;
}
res = 0;
} else
res = sg_ll_send_diag(sg_fd, 0 /* st_code */, true /* pf */,
false /* st */, false /* devofl */,
false /* unitofl */, 1 /* long_duration */,
wp->doutp, do_len, true /* noisy */, verb);
if (op->mc_non) {
/* If non-standard, only call RDR after failed SD */
if (0 == res)
return 0;
/* If RDR error after SD error, prefer reporting SD error */
ret = res;
} else {
switch (op->mc_mode) {
case MODE_DNLD_MC_OFFS:
case MODE_DNLD_MC_OFFS_SAVE:
if (res)
return res;
else if (last) {
if (op->ealsd)
return 0; /* RDR after last may hit a device reset */
}
break;
case MODE_DNLD_MC_OFFS_DEFER:
if (res)
return res;
break;
case MODE_ACTIVATE_MC:
case MODE_ABORT_MC:
if (0 == res) {
if (op->ealsd)
return 0; /* RDR after this may hit a device reset */
}
/* SD has failed, so do a RDR but return SD's error */
ret = res;
break;
default:
pr2serr("%s: mc_mode=0x%x\n", __func__, op->mc_mode);
return SG_LIB_SYNTAX_ERROR;
}
}
if (op->dry_run) {
n = sizeof(dummy_rd_resp);
n = (n < din_len) ? n : din_len;
memcpy(dip, dummy_rd_resp, n);
resid = din_len - n;
res = 0;
} else
res = sg_ll_receive_diag_v2(sg_fd, true /* pcv */,
DPC_DOWNLOAD_MICROCODE, dip, din_len,
0 /* default timeout */, &resid, true,
verb);
if (res)
return ret ? ret : res;
rsp_len = sg_get_unaligned_be16(dip + 2) + 4;
act_len = din_len - resid;
if (rsp_len > din_len) {
pr2serr("<<< warning response buffer too small [%d but need "
"%d]>>>\n", din_len, rsp_len);
rsp_len = din_len;
}
if (rsp_len > act_len) {
pr2serr("<<< warning response too short [actually got %d but need "
"%d]>>>\n", act_len, rsp_len);
rsp_len = act_len;
}
if (rsp_len < 8) {
pr2serr("Download microcode status dpage too short [%d]\n", rsp_len);
return ret ? ret : SG_LIB_CAT_OTHER;
}
rec_gen_code = sg_get_unaligned_be32(dip + 4);
if ((op->verbose > 2) || (op->dry_run && op->verbose)) {
n = 8 + (op->mc_subenc * 16);
pr2serr("rec diag: rsp_len=%d, num_sub-enc=%u rec_gen_code=%u "
"exp_buff_off=%u\n", rsp_len, dip[1],
sg_get_unaligned_be32(dip + 4),
sg_get_unaligned_be32(dip + n + 12));
}
if (rec_gen_code != gen_code)
pr2serr("gen_code changed from %" PRIu32 " to %" PRIu32
", continuing but may fail\n", gen_code, rec_gen_code);
num = (rsp_len - 8) / 16;
if ((rsp_len - 8) % 16)
pr2serr("Found %d Download microcode status descriptors, but there "
"is residual\n", num);
bp = dip + 8;
for (k = 0; k < num; ++k, bp += 16) {
if ((unsigned int)op->mc_subenc == (unsigned int)bp[1]) {
mc_status = bp[2];
cp = get_mc_status_str(mc_status);
if ((mc_status >= 0x80) || op->verbose)
pr2serr("mc offset=%u: status: %s [0x%x, additional=0x%x]\n",
sg_get_unaligned_be32(bp + 12), cp, mc_status, bp[3]);
if (op->verbose > 1)
pr2serr(" subenc_id=%d, expected_buffer_id=%d, "
"expected_offset=0x%" PRIx32 "\n", bp[1], bp[11],
sg_get_unaligned_be32(bp + 12));
if (mc_status >= 0x80)
ret = ret ? ret : SG_LIB_CAT_OTHER;
}
}
return ret;
}
static int
send_then_receive(int sg_fd, uint32_t gen_code, int off_off,
const unsigned char * dmp, int dmp_len,
struct dout_buff_t * wp, unsigned char * dip,
int last, const struct opts_t * op)
{
int do_len, rem, res, rsp_len, k, num, mc_status, verb;
int send_data = 0;
int ret = 0;
uint32_t rec_gen_code;
const unsigned char * ucp;
const char * cp;
verb = (op->verbose > 1) ? op->verbose - 1 : 0;
switch (op->mc_mode) {
case MODE_DNLD_MC_OFFS:
case MODE_DNLD_MC_OFFS_SAVE:
case MODE_DNLD_MC_OFFS_DEFER:
send_data = 1;
do_len = 24 + dmp_len;
rem = do_len % 4;
if (rem)
do_len += (4 - rem);
break;
case MODE_ACTIVATE_MC:
do_len = 24;
break;
default:
pr2serr("send_then_receive: unexpected mc_mode=0x%x\n", op->mc_mode);
return SG_LIB_SYNTAX_ERROR;
}
if (do_len > wp->dout_len) {
if (wp->doutp)
free(wp->doutp);
wp->doutp = (unsigned char *)malloc(do_len);
if (! wp->doutp) {
pr2serr("send_then_receive: unable to malloc %d bytes\n", do_len);
return SG_LIB_CAT_OTHER;
}
wp->dout_len = do_len;
}
memset(wp->doutp, 0, do_len);
wp->doutp[0] = DPC_DOWNLOAD_MICROCODE;
wp->doutp[1] = op->mc_subenc;
sg_put_unaligned_be16(do_len - 4, wp->doutp + 2);
sg_put_unaligned_be32(gen_code, wp->doutp + 4);
wp->doutp[8] = op->mc_mode;
wp->doutp[11] = op->mc_id;
if (send_data)
sg_put_unaligned_be32(op->mc_offset + off_off, wp->doutp + 12);
sg_put_unaligned_be32(op->mc_tlen, wp->doutp + 16);
sg_put_unaligned_be32(dmp_len, wp->doutp + 20);
if (send_data && (dmp_len > 0))
memcpy(wp->doutp + 24, dmp, dmp_len);
/* select long duration timeout (7200 seconds) */
res = sg_ll_send_diag(sg_fd, 0 /* sf_code */, 1 /* pf */, 0 /* sf */,
0 /* devofl */, 0 /* unitofl */,
1 /* long_duration */, wp->doutp, do_len,
1 /* noisy */, verb);
if (op->mc_non) {
/* If non-standard, only call RDR after failed SD */
if (0 == res)
return 0;
/* If RDR error after SD error, prefer reporting SD error */
ret = res;
} else {
switch (op->mc_mode) {
case MODE_DNLD_MC_OFFS:
case MODE_DNLD_MC_OFFS_SAVE:
if (res)
return res;
else if (last)
return 0; /* RDR after last may hit a device reset */
break;
case MODE_DNLD_MC_OFFS_DEFER:
if (res)
return res;
break;
case MODE_ACTIVATE_MC:
if (0 == res)
return 0; /* RDR after ACTIVATE_MC may hit a device reset */
/* SD has failed, so do a RDR but return SD's error */
ret = res;
break;
default:
pr2serr("send_then_receive: mc_mode=0x%x\n", op->mc_mode);
return SG_LIB_SYNTAX_ERROR;
}
}
res = sg_ll_receive_diag(sg_fd, 1 /* pcv */, DPC_DOWNLOAD_MICROCODE, dip,
DEF_DI_LEN, 1, verb);
if (res)
return ret ? ret : res;
rsp_len = sg_get_unaligned_be16(dip + 2) + 4;
if (rsp_len > DEF_DI_LEN) {
pr2serr("<<< warning response buffer too small [%d but need "
"%d]>>>\n", DEF_DI_LEN, rsp_len);
rsp_len = DEF_DI_LEN;
}
if (rsp_len < 8) {
pr2serr("Download microcode status dpage too short\n");
return ret ? ret : SG_LIB_CAT_OTHER;
}
rec_gen_code = sg_get_unaligned_be32(dip + 4);
if (rec_gen_code != gen_code)
pr2serr("gen_code changed from %" PRIu32 " to %" PRIu32
", continuing but may fail\n", gen_code, rec_gen_code);
num = (rsp_len - 8) / 16;
if ((rsp_len - 8) % 16)
pr2serr("Found %d Download microcode status descriptors, but there "
"is residual\n", num);
ucp = dip + 8;
for (k = 0; k < num; ++k, ucp += 16) {
if ((unsigned int)op->mc_subenc == (unsigned int)ucp[1]) {
mc_status = ucp[2];
cp = get_mc_status_str(mc_status);
if ((mc_status >= 0x80) || op->verbose)
pr2serr("mc offset=%d: status: %s [0x%x, additional=0x%x]\n",
off_off, cp, mc_status, ucp[3]);
if (op->verbose > 1)
pr2serr(" subenc_id=%d, expected_buffer_id=%d, "
"expected_offset=0x%" PRIx32 "\n", ucp[1], ucp[11],
sg_get_unaligned_be32(ucp + 12));
if (mc_status >= 0x80)
ret = ret ? ret : SG_LIB_CAT_OTHER;
}
}
return ret;
}