|
@@ -189,15 +189,29 @@ inline void megasas_return_cmd_fusion(struct megasas_instance *instance,
|
|
|
*/
|
|
|
static void
|
|
|
megasas_fire_cmd_fusion(struct megasas_instance *instance,
|
|
|
- union MEGASAS_REQUEST_DESCRIPTOR_UNION *req_desc)
|
|
|
+ union MEGASAS_REQUEST_DESCRIPTOR_UNION *req_desc, bool is_32bit)
|
|
|
{
|
|
|
+ struct megasas_register_set __iomem *regs = instance->reg_set;
|
|
|
+ unsigned long flags;
|
|
|
+
|
|
|
+ if (is_32bit)
|
|
|
+ writel(le32_to_cpu(req_desc->u.low),
|
|
|
+ &(regs)->inbound_single_queue_port);
|
|
|
+ else if (instance->is_ventura) {
|
|
|
+ spin_lock_irqsave(&instance->hba_lock, flags);
|
|
|
+ writel(le32_to_cpu(req_desc->u.low),
|
|
|
+ &(regs)->inbound_low_queue_port);
|
|
|
+ writel(le32_to_cpu(req_desc->u.high),
|
|
|
+ &(regs)->inbound_high_queue_port);
|
|
|
+ mmiowb();
|
|
|
+ spin_unlock_irqrestore(&instance->hba_lock, flags);
|
|
|
+ } else {
|
|
|
#if defined(writeq) && defined(CONFIG_64BIT)
|
|
|
u64 req_data = (((u64)le32_to_cpu(req_desc->u.high) << 32) |
|
|
|
le32_to_cpu(req_desc->u.low));
|
|
|
|
|
|
writeq(req_data, &instance->reg_set->inbound_low_queue_port);
|
|
|
#else
|
|
|
- unsigned long flags;
|
|
|
|
|
|
spin_lock_irqsave(&instance->hba_lock, flags);
|
|
|
writel(le32_to_cpu(req_desc->u.low),
|
|
@@ -207,6 +221,7 @@ megasas_fire_cmd_fusion(struct megasas_instance *instance,
|
|
|
mmiowb();
|
|
|
spin_unlock_irqrestore(&instance->hba_lock, flags);
|
|
|
#endif
|
|
|
+ }
|
|
|
}
|
|
|
|
|
|
/**
|
|
@@ -850,7 +865,7 @@ megasas_ioc_init_fusion(struct megasas_instance *instance)
|
|
|
break;
|
|
|
}
|
|
|
|
|
|
- megasas_fire_cmd_fusion(instance, &req_desc);
|
|
|
+ megasas_fire_cmd_fusion(instance, &req_desc, false);
|
|
|
|
|
|
wait_and_poll(instance, cmd, MFI_POLL_TIMEOUT_SECS);
|
|
|
|
|
@@ -2224,7 +2239,7 @@ megasas_build_and_issue_cmd_fusion(struct megasas_instance *instance,
|
|
|
*/
|
|
|
atomic_inc(&instance->fw_outstanding);
|
|
|
|
|
|
- megasas_fire_cmd_fusion(instance, req_desc);
|
|
|
+ megasas_fire_cmd_fusion(instance, req_desc, instance->is_ventura);
|
|
|
|
|
|
return 0;
|
|
|
}
|
|
@@ -2595,7 +2610,7 @@ megasas_issue_dcmd_fusion(struct megasas_instance *instance,
|
|
|
return DCMD_NOT_FIRED;
|
|
|
}
|
|
|
|
|
|
- megasas_fire_cmd_fusion(instance, req_desc);
|
|
|
+ megasas_fire_cmd_fusion(instance, req_desc, instance->is_ventura);
|
|
|
return DCMD_SUCCESS;
|
|
|
}
|
|
|
|
|
@@ -2888,7 +2903,8 @@ void megasas_refire_mgmt_cmd(struct megasas_instance *instance)
|
|
|
cpu_to_le32(MR_DCMD_SYSTEM_PD_MAP_GET_INFO)))
|
|
|
&& !(cmd_mfi->flags & DRV_DCMD_SKIP_REFIRE);
|
|
|
if (refire_cmd)
|
|
|
- megasas_fire_cmd_fusion(instance, req_desc);
|
|
|
+ megasas_fire_cmd_fusion(instance, req_desc,
|
|
|
+ instance->is_ventura);
|
|
|
else
|
|
|
megasas_return_cmd(instance, cmd_mfi);
|
|
|
}
|
|
@@ -3067,7 +3083,7 @@ megasas_issue_tm(struct megasas_instance *instance, u16 device_handle,
|
|
|
mr_request->tmReqFlags.isTMForLD = 1;
|
|
|
|
|
|
init_completion(&cmd_fusion->done);
|
|
|
- megasas_fire_cmd_fusion(instance, req_desc);
|
|
|
+ megasas_fire_cmd_fusion(instance, req_desc, instance->is_ventura);
|
|
|
|
|
|
timeleft = wait_for_completion_timeout(&cmd_fusion->done, 50 * HZ);
|
|
|
|