26 static int ufshcd_program_key(struct ufs_hba *hba,  in ufshcd_program_key()  argument
30 	u32 slot_offset = hba->crypto_cfg_register + slot * sizeof(*cfg);  in ufshcd_program_key()
33 	ufshcd_hold(hba, false);  in ufshcd_program_key()
35 	if (hba->vops && hba->vops->program_key) {  in ufshcd_program_key()
36 		err = hba->vops->program_key(hba, cfg, slot);  in ufshcd_program_key()
41 	ufshcd_writel(hba, 0, slot_offset + 16 * sizeof(cfg->reg_val[0]));  in ufshcd_program_key()
43 		ufshcd_writel(hba, le32_to_cpu(cfg->reg_val[i]),  in ufshcd_program_key()
47 	ufshcd_writel(hba, le32_to_cpu(cfg->reg_val[17]),  in ufshcd_program_key()
50 	ufshcd_writel(hba, le32_to_cpu(cfg->reg_val[16]),  in ufshcd_program_key()
53 	ufshcd_release(hba);  in ufshcd_program_key()
61 	struct ufs_hba *hba =  in ufshcd_crypto_keyslot_program()  local
63 	const union ufs_crypto_cap_entry *ccap_array = hba->crypto_cap_array;  in ufshcd_crypto_keyslot_program()
73 	for (i = 0; i < hba->crypto_capabilities.num_crypto_cap; i++) {  in ufshcd_crypto_keyslot_program()
98 	err = ufshcd_program_key(hba, &cfg, slot);  in ufshcd_crypto_keyslot_program()
104 static int ufshcd_clear_keyslot(struct ufs_hba *hba, int slot)  in ufshcd_clear_keyslot()  argument
112 	return ufshcd_program_key(hba, &cfg, slot);  in ufshcd_clear_keyslot()
119 	struct ufs_hba *hba =  in ufshcd_crypto_keyslot_evict()  local
122 	return ufshcd_clear_keyslot(hba, slot);  in ufshcd_crypto_keyslot_evict()
125 bool ufshcd_crypto_enable(struct ufs_hba *hba)  in ufshcd_crypto_enable()  argument
127 	if (!(hba->caps & UFSHCD_CAP_CRYPTO))  in ufshcd_crypto_enable()
131 	if (hba->crypto_profile.num_slots) {  in ufshcd_crypto_enable()
134 		trace_android_rvh_ufs_reprogram_all_keys(hba, &err);  in ufshcd_crypto_enable()
136 			blk_crypto_reprogram_all_keys(&hba->crypto_profile);  in ufshcd_crypto_enable()
139 	if (hba->android_quirks & UFSHCD_ANDROID_QUIRK_BROKEN_CRYPTO_ENABLE)  in ufshcd_crypto_enable()
172 int ufshcd_hba_init_crypto_capabilities(struct ufs_hba *hba)  in ufshcd_hba_init_crypto_capabilities()  argument
178 	if (hba->android_quirks & UFSHCD_ANDROID_QUIRK_CUSTOM_CRYPTO_PROFILE)  in ufshcd_hba_init_crypto_capabilities()
186 	if (!(hba->capabilities & MASK_CRYPTO_SUPPORT) ||  in ufshcd_hba_init_crypto_capabilities()
187 	    !(hba->caps & UFSHCD_CAP_CRYPTO))  in ufshcd_hba_init_crypto_capabilities()
190 	hba->crypto_capabilities.reg_val =  in ufshcd_hba_init_crypto_capabilities()
191 			cpu_to_le32(ufshcd_readl(hba, REG_UFS_CCAP));  in ufshcd_hba_init_crypto_capabilities()
192 	hba->crypto_cfg_register =  in ufshcd_hba_init_crypto_capabilities()
193 		(u32)hba->crypto_capabilities.config_array_ptr * 0x100;  in ufshcd_hba_init_crypto_capabilities()
194 	hba->crypto_cap_array =  in ufshcd_hba_init_crypto_capabilities()
195 		devm_kcalloc(hba->dev, hba->crypto_capabilities.num_crypto_cap,  in ufshcd_hba_init_crypto_capabilities()
196 			     sizeof(hba->crypto_cap_array[0]), GFP_KERNEL);  in ufshcd_hba_init_crypto_capabilities()
197 	if (!hba->crypto_cap_array) {  in ufshcd_hba_init_crypto_capabilities()
204 			hba->dev, &hba->crypto_profile,  in ufshcd_hba_init_crypto_capabilities()
205 			hba->crypto_capabilities.config_count + 1);  in ufshcd_hba_init_crypto_capabilities()
209 	hba->crypto_profile.ll_ops = ufshcd_crypto_ops;  in ufshcd_hba_init_crypto_capabilities()
211 	hba->crypto_profile.max_dun_bytes_supported = 8;  in ufshcd_hba_init_crypto_capabilities()
212 	hba->crypto_profile.key_types_supported = BLK_CRYPTO_KEY_TYPE_STANDARD;  in ufshcd_hba_init_crypto_capabilities()
213 	hba->crypto_profile.dev = hba->dev;  in ufshcd_hba_init_crypto_capabilities()
219 	for (cap_idx = 0; cap_idx < hba->crypto_capabilities.num_crypto_cap;  in ufshcd_hba_init_crypto_capabilities()
221 		hba->crypto_cap_array[cap_idx].reg_val =  in ufshcd_hba_init_crypto_capabilities()
222 			cpu_to_le32(ufshcd_readl(hba,  in ufshcd_hba_init_crypto_capabilities()
226 						hba->crypto_cap_array[cap_idx]);  in ufshcd_hba_init_crypto_capabilities()
228 			hba->crypto_profile.modes_supported[blk_mode_num] |=  in ufshcd_hba_init_crypto_capabilities()
229 				hba->crypto_cap_array[cap_idx].sdus_mask * 512;  in ufshcd_hba_init_crypto_capabilities()
236 	hba->caps &= ~UFSHCD_CAP_CRYPTO;  in ufshcd_hba_init_crypto_capabilities()
244 void ufshcd_init_crypto(struct ufs_hba *hba)  in ufshcd_init_crypto()  argument
248 	if (!(hba->caps & UFSHCD_CAP_CRYPTO))  in ufshcd_init_crypto()
252 	for (slot = 0; slot < hba->crypto_profile.num_slots; slot++)  in ufshcd_init_crypto()
253 		hba->crypto_profile.ll_ops.keyslot_evict(&hba->crypto_profile,  in ufshcd_init_crypto()
257 void ufshcd_crypto_register(struct ufs_hba *hba, struct request_queue *q)  in ufshcd_crypto_register()  argument
259 	if (hba->caps & UFSHCD_CAP_CRYPTO)  in ufshcd_crypto_register()
260 		blk_crypto_register(&hba->crypto_profile, q);  in ufshcd_crypto_register()