int ufs_get_device_info(struct ufs_hba *hba, struct ufs_card_info *card_data)
{
int err;
u8 model_index;
u8 str_desc_buf[QUERY_DESC_STRING_MAX_SIZE];
u8 desc_buf[QUERY_DESC_DEVICE_MAX_SIZE];
err = ufshcd_read_device_desc(hba, desc_buf,
QUERY_DESC_DEVICE_MAX_SIZE);
if (err)
goto out;
card_data->vendor = desc_buf[DEVICE_DESC_PARAM_MANF_ID + 1];
model_index = desc_buf[DEVICE_DESC_PARAM_PRDCT_NAME];
memset(str_desc_buf, 0, QUERY_DESC_STRING_MAX_SIZE);
err = ufshcd_read_string_desc(hba, model_index, str_desc_buf,
QUERY_DESC_STRING_MAX_SIZE, ASCII_STD);
if (err)
goto out;
strlcpy(card_data->model, str_desc_buf, MAX_MODEL_LEN + 1);
out:
return err;
}
int ufs_get_device_info(struct ufs_hba *hba, struct ufs_card_info *card_data)
{
int err;
u8 model_index;
u8 serial_num_index;
u8 serial_num_buf[6]; /* samsung spec : use only 6 bytes of serial number string descriptor */
u8 str_desc_buf[QUERY_DESC_STRING_MAX_SIZE + 1];
u8 desc_buf[QUERY_DESC_DEVICE_MAX_SIZE];
u8 health_buf[QUERY_DESC_HEALTH_MAX_SIZE];
bool ascii_type;
err = ufshcd_read_device_desc(hba, desc_buf,
QUERY_DESC_DEVICE_MAX_SIZE);
if (err)
goto out;
err = ufshcd_read_health_desc(hba, health_buf,
QUERY_DESC_HEALTH_MAX_SIZE);
if (err)
printk("%s: DEVICE_HEALTH desc read fail, err = %d\n", __FUNCTION__, err);
/* getting Life Time at Device Health DESC*/
card_data->lifetime = health_buf[HEALTH_DEVICE_DESC_PARAM_LIFETIMEA];
/*
* getting vendor (manufacturerID) and Bank Index in big endian
* format
*/
card_data->wmanufacturerid = desc_buf[DEVICE_DESC_PARAM_MANF_ID] << 8 |
desc_buf[DEVICE_DESC_PARAM_MANF_ID + 1];
hba->manufacturer_id = card_data->wmanufacturerid;
hba->lifetime = card_data->lifetime;
model_index = desc_buf[DEVICE_DESC_PARAM_PRDCT_NAME];
memset(str_desc_buf, 0, QUERY_DESC_STRING_MAX_SIZE);
err = ufshcd_read_string_desc(hba, model_index, str_desc_buf,
QUERY_DESC_STRING_MAX_SIZE, ASCII_STD);
if (err)
goto out;
str_desc_buf[QUERY_DESC_STRING_MAX_SIZE] = '\0';
strlcpy(card_data->model, (str_desc_buf + QUERY_DESC_HDR_SIZE),
min_t(u8, str_desc_buf[QUERY_DESC_LENGTH_OFFSET],
MAX_MODEL_LEN));
/* Null terminate the model string */
card_data->model[MAX_MODEL_LEN] = '\0';
/* make unique id with MANUFACTURE DATE & SERIAL NUMBER */
serial_num_index = desc_buf[DEVICE_DESC_PARAM_SN];
memset(str_desc_buf, 0, QUERY_DESC_STRING_MAX_SIZE);
/*Samsung device use UTF16*/
if ((hba->manufacturer_id == UFS_VENDOR_ID_SAMSUNG) || (hba->manufacturer_id == UFS_VENDOR_ID_TOSHIBA))
ascii_type = UTF16_STD;
else
ascii_type = ASCII_STD;
err = ufshcd_read_string_desc(hba, serial_num_index, str_desc_buf,
QUERY_DESC_STRING_MAX_SIZE, ascii_type);
if (err)
goto out;
str_desc_buf[QUERY_DESC_STRING_MAX_SIZE] = '\0';
memset(serial_num_buf, 0, sizeof(serial_num_buf));
memcpy(serial_num_buf, str_desc_buf + QUERY_DESC_HDR_SIZE, sizeof(serial_num_buf));
memset(hba->unique_number, 0, sizeof(hba->unique_number));
sprintf(hba->unique_number, "%02x%02x%02x%02x%02x%02x%02x%02x", desc_buf[DEVICE_DESC_PARAM_MANF_DATE], desc_buf[DEVICE_DESC_PARAM_MANF_DATE+1], serial_num_buf[0], serial_num_buf[1], serial_num_buf[2], serial_num_buf[3], serial_num_buf[4], serial_num_buf[5]);
/* Null terminate the unique number string */
hba->unique_number[UFS_UNIQUE_NUMBER_LEN - 1] = '\0';
printk("%s: UNIQUE NUMBER = %s , Lifetime: 0x%02x \n", __FUNCTION__, hba->unique_number, health_buf[3]<<4|health_buf[4]);
out:
return err;
}