mirror of
git://nv-tegra.nvidia.com/linux-nv-oot.git
synced 2025-12-22 17:25:35 +03:00
- Move resource init specific to PM and bootstrap modules
to respective PM and bootstrap init functions.
- Motivation here is 2 fold:
1) To keep common code common across OSs.
2) Move resource init to respective sub-modules.
- We will have separate PM module for HVRTOS.
- We will have separate dce-worker module for HVRTOS.
JIRA TDS-16052
Change-Id: I40f6943eb4173a0da7201dc58afb19aee2a0d04e
Signed-off-by: anupamg <anupamg@nvidia.com>
Reviewed-on: https://git-master.nvidia.com/r/c/linux-nv-oot/+/3190873
Reviewed-by: Arun Swain <arswain@nvidia.com>
GVS: buildbot_gerritrpt <buildbot_gerritrpt@nvidia.com>
Reviewed-by: svcacv <svcacv@nvidia.com>
Reviewed-by: Mahesh Kumar <mahkumar@nvidia.com>
875 lines
20 KiB
C
875 lines
20 KiB
C
// SPDX-License-Identifier: GPL-2.0-only
|
|
/*
|
|
* SPDX-FileCopyrightText: Copyright (c) 2019-2024 NVIDIA CORPORATION & AFFILIATES. All rights reserved.
|
|
*/
|
|
#include <dce.h>
|
|
#include <os-utils.h>
|
|
#include <interface/dce-interface.h>
|
|
#include <interface/dce-boot-cmds.h>
|
|
|
|
/**
|
|
* dce_fw_boot_complete - Checks if dce has complelted boot.
|
|
*
|
|
* @d - Pointer to tegra_dce struct.
|
|
*
|
|
* Return : True if boot is complete
|
|
*/
|
|
inline bool dce_fw_boot_complete(struct tegra_dce *d)
|
|
{
|
|
return !!(d->hsp.ss_get_state(d, d->hsp_id, DCE_BOOT_SEMA)
|
|
& DCE_BOOT_COMPLETE);
|
|
}
|
|
|
|
/**
|
|
* dce_request_fw_boot_complete - Requests DCE to raise an
|
|
* interrupt on boot completion.
|
|
*
|
|
* @d - Pointer to tegra_dce struct.
|
|
*
|
|
* Return : void
|
|
*/
|
|
inline void dce_request_fw_boot_complete(struct tegra_dce *d)
|
|
{
|
|
#define DCE_BOOT_INIT_BPOS 31U
|
|
d->hsp.ss_set(d, DCE_BOOT_INIT_BPOS, d->hsp_id, DCE_BOOT_SEMA);
|
|
#undef DCE_BOOT_INIT_BPOS
|
|
}
|
|
|
|
/**
|
|
* dce_handle_boot_cmd_requested_event - callback handler function for event
|
|
* EVENT_ID_DCE_BOOT_CMD_MSG_REQUESTED
|
|
*
|
|
* @d : Pointer to tegra_dce struct.
|
|
* @params : callback params
|
|
*
|
|
* Return : 0 if successful else error code
|
|
*/
|
|
int dce_handle_boot_cmd_requested_event(struct tegra_dce *d, void *params)
|
|
{
|
|
int ret = 0;
|
|
struct dce_mailbox_send_cmd_params *mbox_params =
|
|
(struct dce_mailbox_send_cmd_params *)params;
|
|
|
|
dce_debug(d, "cmd:%u interface:%u", mbox_params->cmd, mbox_params->interface);
|
|
|
|
ret = dce_handle_mailbox_send_cmd_sync(d, mbox_params->cmd,
|
|
mbox_params->interface);
|
|
|
|
return ret;
|
|
}
|
|
|
|
/**
|
|
* dce_handle_boot_cmd_received_event - callback handler function for event
|
|
* EVENT_ID_DCE_BOOT_CMD_MSG_RECEIVED
|
|
*
|
|
* @d : Pointer to tegra_dce struct.
|
|
* @params : callback params
|
|
*
|
|
* Return : 0 if successful else error code
|
|
*/
|
|
int dce_handle_boot_cmd_received_event(struct tegra_dce *d, void *params)
|
|
{
|
|
USE(params);
|
|
dce_wakeup_interruptible(d, DCE_WAIT_BOOT_CMD);
|
|
return 0;
|
|
}
|
|
|
|
/**
|
|
* dce_handle_boot_complete_requested_event - callback handler function for
|
|
* event EVENT_ID_DCE_BOOT_COMPLETE_REQUESTED
|
|
*
|
|
* Wait for the DCE to boot and be ready to receive commands from CCPLEX driver.
|
|
*
|
|
* @d : Pointer to tegra_dce struct.
|
|
* @params : callback params
|
|
*
|
|
* Return : 0 if successful else error code
|
|
*/
|
|
int dce_handle_boot_complete_requested_event(struct tegra_dce *d, void *params)
|
|
{
|
|
USE(params);
|
|
int ret = 0;
|
|
|
|
d->boot_status |= DCE_FW_EARLY_BOOT_START;
|
|
if (dce_fw_boot_complete(d)) {
|
|
ret = dce_fsm_post_event(d, EVENT_ID_DCE_BOOT_COMPLETE_RECEIVED, NULL);
|
|
if (ret)
|
|
dce_err(d, "failed to send DCE_BOOT_COMPLETE_RECEIVED event");
|
|
|
|
dce_cond_wait_reset(d, DCE_WAIT_BOOT_COMPLETE);
|
|
goto boot_done;
|
|
}
|
|
|
|
dce_request_fw_boot_complete(d);
|
|
|
|
dce_debug(d, "Waiting for dce fw to boot...");
|
|
|
|
ret = dce_wait_interruptible(d, DCE_WAIT_BOOT_COMPLETE);
|
|
if (ret) {
|
|
/**
|
|
* TODO: Add error handling for abort and retry
|
|
*/
|
|
dce_err(d, "dce boot wait was interrupted with err:%d", ret);
|
|
}
|
|
|
|
boot_done:
|
|
if (!ret) {
|
|
dce_set_boot_complete(d, true);
|
|
d->boot_status |= DCE_FW_EARLY_BOOT_DONE;
|
|
dce_debug(d, "dce is ready to receive bootstrap commands");
|
|
} else {
|
|
d->boot_status |= DCE_FW_EARLY_BOOT_FAILED;
|
|
}
|
|
|
|
return ret;
|
|
}
|
|
|
|
/**
|
|
* dce_handle_boot_complete_received_event - callback handler function for
|
|
* event EVENT_ID_DCE_BOOT_CMD_MSG_RECEIVED
|
|
*
|
|
* @d : Pointer to tegra_dce struct.
|
|
* @params : callback params
|
|
*
|
|
* Return : 0 if successful else error code
|
|
*/
|
|
int dce_handle_boot_complete_received_event(struct tegra_dce *d, void *params)
|
|
{
|
|
USE(params);
|
|
dce_wakeup_interruptible(d, DCE_WAIT_BOOT_COMPLETE);
|
|
return 0;
|
|
}
|
|
|
|
/*
|
|
* dce_start_boot_flow : Start dce bootstrap flow
|
|
*
|
|
* @d : Pointer to tegra_dce struct.
|
|
*
|
|
* Return : 0 if successful else error code
|
|
*/
|
|
int
|
|
dce_start_boot_flow(struct tegra_dce *d)
|
|
{
|
|
int ret = 0;
|
|
|
|
ret = dce_start_bootstrap_flow(d);
|
|
if (ret) {
|
|
dce_err(d, "DCE_BOOT_FAILED: Bootstrap flow didn't complete");
|
|
goto exit;
|
|
}
|
|
|
|
dce_admin_ivc_channel_reset(d);
|
|
dce_usleep_range(10, 50);
|
|
|
|
ret = dce_start_admin_seq(d);
|
|
if (ret) {
|
|
dce_err(d, "DCE_BOOT_FAILED: Admin flow didn't complete");
|
|
} else {
|
|
d->boot_status |= DCE_FW_BOOT_DONE;
|
|
dce_info(d, "DCE_BOOT_DONE");
|
|
dce_cond_broadcast_interruptible(&d->dce_bootstrap_done);
|
|
}
|
|
|
|
exit:
|
|
if (ret)
|
|
d->boot_status |= DCE_STATUS_FAILED;
|
|
|
|
return ret;
|
|
}
|
|
|
|
/**
|
|
* dce_bootstrap_work_fn : execute fsm start and bootstrap flow
|
|
*
|
|
* @d : Pointer to tegra_dce struct.
|
|
*
|
|
* Return : void
|
|
*/
|
|
void dce_bootstrap_work_fn(struct tegra_dce *d)
|
|
{
|
|
int ret = 0;
|
|
|
|
if (d == NULL) {
|
|
dce_err(d, "tegra_dce struct is NULL");
|
|
return;
|
|
}
|
|
|
|
ret = dce_fsm_post_event(d, EVENT_ID_DCE_FSM_START, NULL);
|
|
if (ret) {
|
|
dce_err(d, "FSM start failed\n");
|
|
return;
|
|
}
|
|
|
|
ret = dce_fsm_post_event(d, EVENT_ID_DCE_BOOT_COMPLETE_REQUESTED, NULL);
|
|
if (ret) {
|
|
dce_err(d, "Error while posting DCE_BOOT_COMPLETE_REQUESTED event");
|
|
return;
|
|
}
|
|
|
|
ret = dce_start_boot_flow(d);
|
|
if (ret) {
|
|
dce_err(d, "DCE bootstrapping failed\n");
|
|
return;
|
|
}
|
|
}
|
|
|
|
/**
|
|
* dce_handle_irq_status - Handles irq status from DCE
|
|
*
|
|
* @d : Pointer to struct tegra_dce
|
|
* @status : Status received from DCE
|
|
*
|
|
* Return : Void
|
|
*/
|
|
static void dce_handle_irq_status(struct tegra_dce *d, u32 status)
|
|
{
|
|
|
|
if (status & DCE_IRQ_LOG_OVERFLOW)
|
|
dce_info(d, "DCE trace log overflow error received");
|
|
|
|
if (status & DCE_IRQ_CRASH_LOG)
|
|
dce_info(d, "DCE crash log available");
|
|
|
|
if (status & DCE_IRQ_ABORT)
|
|
dce_err(d, "DCE ucode abort occurred");
|
|
|
|
if (status & DCE_IRQ_READY) {
|
|
dce_debug(d, "DCE IRQ Ready Received");
|
|
(void)dce_fsm_post_event(d,
|
|
EVENT_ID_DCE_BOOT_COMPLETE_RECEIVED,
|
|
NULL);
|
|
}
|
|
|
|
if (status & DCE_IRQ_SC7_ENTERED) {
|
|
dce_info(d, "DCE can be safely powered-off now");
|
|
(void)dce_fsm_post_event(d,
|
|
EVENT_ID_DCE_SC7_ENTERED_RECEIVED,
|
|
NULL);
|
|
}
|
|
|
|
if (status & DCE_IRQ_LOG_READY) {
|
|
dce_info(d, "DCE trace log buffers available");
|
|
dce_wakeup_interruptible(d, DCE_WAIT_LOG);
|
|
}
|
|
|
|
/*
|
|
* FIXME: handle individual bits
|
|
*/
|
|
if (status & (DCE_IRQ_LOG_OVERFLOW | DCE_IRQ_CRASH_LOG |
|
|
DCE_IRQ_ABORT)) {
|
|
// Wrapper function around this ??
|
|
// TODO: Wake All other waiting processes
|
|
(void) dce_fsm_post_event(d, EVENT_ID_DCE_ABORT_RECEIVED, NULL);
|
|
}
|
|
}
|
|
|
|
|
|
/**
|
|
* dce_bootstrap_handle_boot_status- Handles boot status from DCE
|
|
*
|
|
* @d : Pointer to struct tegra_dce
|
|
* @status : Status received from DCE
|
|
*
|
|
* Return : Void
|
|
*/
|
|
static void dce_bootstrap_handle_boot_status(struct tegra_dce *d, u32 status)
|
|
{
|
|
int ret = 0;
|
|
dce_mailbox_store_interface_status(d, status,
|
|
DCE_MAILBOX_BOOT_INTERFACE);
|
|
|
|
ret = dce_fsm_post_event(d, EVENT_ID_DCE_BOOT_CMD_MSG_RECEIVED, NULL);
|
|
if (ret)
|
|
dce_err(d, "Mbox bootstrap cmd failed");
|
|
}
|
|
|
|
|
|
/**
|
|
* dce_boot_interface_isr - Isr for the CCPLEX<->DCE boot interface.
|
|
*
|
|
* @d : Pointer to tegra_dce struct.
|
|
*
|
|
* Return : Void
|
|
*/
|
|
static void dce_boot_interface_isr(struct tegra_dce *d, void *data)
|
|
{
|
|
USE(data);
|
|
u32 status;
|
|
u8 interface_id = DCE_MAILBOX_BOOT_INTERFACE;
|
|
|
|
status = dce_mailbox_get_interface_status(d, interface_id);
|
|
if (status == 0xffffffff)
|
|
return;
|
|
|
|
switch (DCE_IRQ_GET_STATUS_TYPE(status)) {
|
|
case DCE_IRQ_STATUS_TYPE_IRQ:
|
|
dce_handle_irq_status(d, status);
|
|
break;
|
|
case DCE_IRQ_STATUS_TYPE_BOOT_CMD:
|
|
dce_bootstrap_handle_boot_status(d, status);
|
|
break;
|
|
default:
|
|
dce_info(d, "Invalid Status Received from DCE. Status: [%x]",
|
|
status);
|
|
break;
|
|
}
|
|
}
|
|
|
|
/**
|
|
* dce_parse_boot_status_err - Parses the error sent by DCE
|
|
*
|
|
* @d : Pointer to struct tegra_dce
|
|
* @status : Status read from mailbox
|
|
*
|
|
* Return : Void
|
|
*/
|
|
static void dce_parse_boot_status_err(struct tegra_dce *d, u32 status)
|
|
{
|
|
#define DCE_BOOT_ERR_MASK 0x7FFFFF
|
|
status &= DCE_BOOT_ERR_MASK;
|
|
#undef DCE_BOOT_ERR_MASK
|
|
|
|
switch (status) {
|
|
case DCE_BOOT_CMD_ERR_BAD_COMMAND:
|
|
dce_info(d, "Boot Status Error : DCE_BOOT_CMD_ERR_BAD_COMMAND");
|
|
break;
|
|
case DCE_BOOT_CMD_ERR_UNIMPLEMENTED:
|
|
dce_info(d, "Boot Status Error : DCE_BOOT_CMD_ERR_UNIMPLEMENTED");
|
|
break;
|
|
case DCE_BOOT_CMD_ERR_IPC_SETUP:
|
|
dce_info(d, "Boot Status Error : DCE_BOOT_CMD_ERR_IPC_SETUP");
|
|
break;
|
|
case DCE_BOOT_CMD_ERR_INVALID_NFRAMES:
|
|
dce_info(d, "Boot Status Error : DCE_BOOT_CMD_ERR_INVALID_NFRAMES");
|
|
break;
|
|
case DCE_BOOT_CMD_ERR_IPC_CREATE:
|
|
dce_info(d, "Boot Status Error : DCE_BOOT_CMD_ERR_IPC_CREATE");
|
|
break;
|
|
case DCE_BOOT_CMD_ERR_LOCKED:
|
|
dce_info(d, "Boot Status Error : DCE_BOOT_CMD_ERR_LOCKED");
|
|
break;
|
|
default:
|
|
dce_info(d, "Invalid Error Status Rcvd. Status: [%x]", status);
|
|
break;
|
|
}
|
|
}
|
|
|
|
/**
|
|
* dce_mailbox_wait_boot_interface - Waits for mailbox messages.
|
|
*
|
|
* @d : Pointer to tegra_dce
|
|
*
|
|
* Return : 0 if successful
|
|
*/
|
|
static int dce_mailbox_wait_boot_interface(struct tegra_dce *d)
|
|
{
|
|
u32 status;
|
|
int ret;
|
|
|
|
ret = dce_wait_interruptible(d, DCE_WAIT_BOOT_CMD);
|
|
if (ret) {
|
|
/**
|
|
* TODO: Add error handling for abort and retry
|
|
*/
|
|
dce_err(d, "dce mbox wait was interrupted with err:%d", ret);
|
|
}
|
|
|
|
status = dce_mailbox_get_interface_status(d,
|
|
DCE_MAILBOX_BOOT_INTERFACE);
|
|
|
|
if (status & DCE_BOOT_CMD_ERR_FLAG) {
|
|
dce_parse_boot_status_err(d, status);
|
|
dce_err(d, "Error code received on boot interface : 0x%x",
|
|
status);
|
|
return -EBADE;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
/**
|
|
* dce_boot_interface_init - Initializes the dce boot interface
|
|
* and the associated resources.
|
|
*
|
|
* @d : Pointer to tegra_dce struct
|
|
*
|
|
* Return : 0 if successful
|
|
*/
|
|
int dce_boot_interface_init(struct tegra_dce *d)
|
|
{
|
|
int ret = 0;
|
|
u8 mailbox_id = DCE_MAILBOX_BOOT_INTERFACE;
|
|
|
|
ret = dce_mailbox_init_interface(d, mailbox_id,
|
|
DCE_MBOX_BOOT_CMD, DCE_MBOX_IRQ,
|
|
dce_mailbox_wait_boot_interface,
|
|
NULL, dce_boot_interface_isr);
|
|
if (ret) {
|
|
dce_err(d, "Boot Mailbox Interface Init Failed");
|
|
goto err_init;
|
|
}
|
|
|
|
ret = dce_init_work(d, &d->dce_bootstrap_work, dce_bootstrap_work_fn);
|
|
if (ret) {
|
|
dce_err(d, "Bootstrap work init failed");
|
|
goto err_init;
|
|
}
|
|
|
|
err_init:
|
|
return ret;
|
|
}
|
|
|
|
/**
|
|
* dce_boot_interface_deinit - Releases the resources
|
|
* associated with dce boot.
|
|
*
|
|
* @d : Pointer to tegra_dce struct.
|
|
*
|
|
* Return : Void
|
|
*/
|
|
void dce_boot_interface_deinit(struct tegra_dce *d)
|
|
{
|
|
dce_mailbox_deinit_interface(d,
|
|
DCE_MAILBOX_BOOT_INTERFACE);
|
|
}
|
|
|
|
/**
|
|
* dce_send_version_cmd - Sends the "VERSION" command to dce fw
|
|
*
|
|
* @d : Pointer to tegra_dce struct
|
|
*
|
|
* Return : 0 if successful
|
|
*/
|
|
static int dce_send_version_cmd(struct tegra_dce *d)
|
|
{
|
|
u32 val;
|
|
int ret = 0;
|
|
|
|
val = DCE_BOOT_CMD_SET(0U, DCE_BOOT_CMD_VERSION);
|
|
|
|
ret = dce_mailbox_send_cmd_sync(d, val, DCE_MAILBOX_BOOT_INTERFACE);
|
|
|
|
return ret;
|
|
}
|
|
|
|
/**
|
|
* dce_send_set_sid_cmd - Sends the "SET_SID" command to dce fw
|
|
*
|
|
* @d : Pointer to tegra_dce struct
|
|
*
|
|
* Return : 0 if successful
|
|
*/
|
|
static int dce_send_set_sid_cmd(struct tegra_dce *d)
|
|
{
|
|
u32 val;
|
|
int ret = 0;
|
|
|
|
val = DCE_BOOT_CMD_SET(0U, DCE_BOOT_CMD_SET_SID) |
|
|
DCE_BOOT_CMD_PARM_SET(0, dce_get_dce_stream_id(d));
|
|
|
|
ret = dce_mailbox_send_cmd_sync(d, val, DCE_MAILBOX_BOOT_INTERFACE);
|
|
|
|
return ret;
|
|
}
|
|
|
|
/**
|
|
* dce_send_channel_int_cmd - Sends the "CHANNEL_INIT" command to dce fw
|
|
*
|
|
* @d : Pointer to tegra_dce struct
|
|
*
|
|
* Return : 0 if successful
|
|
*/
|
|
static int dce_send_channel_int_cmd(struct tegra_dce *d)
|
|
{
|
|
u32 val;
|
|
int ret = 0;
|
|
|
|
val = DCE_BOOT_CMD_SET(0U, DCE_BOOT_CMD_CHANNEL_INIT);
|
|
|
|
ret = dce_mailbox_send_cmd_sync(d, val, DCE_MAILBOX_BOOT_INTERFACE);
|
|
|
|
return ret;
|
|
}
|
|
|
|
/**
|
|
* dce_send_set_addr_read_cmd_hi - Sends addr_hi cmd to dce fw.
|
|
*
|
|
* @d : Pointer to tegra_dce struct.
|
|
* @addr : IOVA addr to be sent.
|
|
* @rd_wr : Tells if the addr to be sent is for read or write
|
|
* interface.
|
|
*
|
|
* Return : 0 if successful
|
|
*/
|
|
static int dce_send_set_addr_cmd_hi(struct tegra_dce *d, u32 addr, u8 rd_wr)
|
|
{
|
|
u32 val;
|
|
int ret = 0;
|
|
|
|
val = DCE_BOOT_CMD_SET_HILO(0U, 1U) |
|
|
DCE_BOOT_CMD_SET_RDWR(0U, rd_wr) |
|
|
DCE_BOOT_CMD_SET(0U, DCE_BOOT_CMD_SET_ADDR) |
|
|
DCE_BOOT_CMD_PARM_SET(0U, addr);
|
|
|
|
ret = dce_mailbox_send_cmd_sync(d, val, DCE_MAILBOX_BOOT_INTERFACE);
|
|
|
|
return ret;
|
|
}
|
|
|
|
/**
|
|
* dce_send_set_addr_read_cmd_lo - Sends addr_lo cmd to dce fw.
|
|
*
|
|
* @d : Pointer to tegra_dce struct.
|
|
* @addr : IOVA addr to be sent.
|
|
* @rd_wr : Tells if the addr to be sent is for read or write
|
|
* interface.
|
|
*
|
|
* Return : 0 if successful
|
|
*/
|
|
static int dce_send_set_addr_cmd_lo(struct tegra_dce *d, u32 addr, u8 rd_wr)
|
|
{
|
|
u32 val;
|
|
int ret = 0;
|
|
|
|
val = DCE_BOOT_CMD_SET_HILO(0U, 0U) |
|
|
DCE_BOOT_CMD_SET_RDWR(0U, rd_wr) |
|
|
DCE_BOOT_CMD_SET(0U, DCE_BOOT_CMD_SET_ADDR) |
|
|
DCE_BOOT_CMD_PARM_SET(0U, addr);
|
|
|
|
ret = dce_mailbox_send_cmd_sync(d, val, DCE_MAILBOX_BOOT_INTERFACE);
|
|
|
|
return ret;
|
|
}
|
|
|
|
/**
|
|
* dce_send_set_addr_read_cmd - Sends the addresses for admin
|
|
* read interface to dce fw.
|
|
*
|
|
* @d : Pointer to tegra_dce struct
|
|
* @rd_buff : Read address
|
|
*
|
|
* Return : 0 if successful
|
|
*/
|
|
static int dce_send_set_addr_read_cmd(struct tegra_dce *d, const u64 rd_buff)
|
|
{
|
|
int ret = 0;
|
|
|
|
#define DCE_DATA_NBITS_SHIFT 20
|
|
ret = dce_send_set_addr_cmd_hi(d, rd_buff >> DCE_DATA_NBITS_SHIFT, 0);
|
|
if (ret) {
|
|
dce_err(d, "Sending of SEND_ADDR for READ IOVA HI failed");
|
|
goto err_sending;
|
|
}
|
|
|
|
ret = dce_send_set_addr_cmd_lo(d, rd_buff, 0);
|
|
if (ret) {
|
|
dce_err(d, "Sending of SEND_ADDR for READ IOVA LO failed");
|
|
goto err_sending;
|
|
}
|
|
#undef DCE_DATA_NBITS_SHIFT
|
|
|
|
err_sending:
|
|
return ret;
|
|
}
|
|
|
|
/**
|
|
* dce_send_set_addr_write_cmd - Sends the addresses for admin
|
|
* write interface to dce fw.
|
|
*
|
|
* @d : Pointer to tegra_dce struct
|
|
* @wr_buff : Write address
|
|
*
|
|
* Return : 0 if successful
|
|
*/
|
|
static int dce_send_set_addr_write_cmd(struct tegra_dce *d, const u64 wr_buff)
|
|
{
|
|
int ret = 0;
|
|
|
|
#define DCE_DATA_NBITS_SHIFT 20
|
|
ret = dce_send_set_addr_cmd_hi(d, wr_buff >> DCE_DATA_NBITS_SHIFT, 1);
|
|
if (ret) {
|
|
dce_err(d, "Sending of SEND_ADDR for READ IOVA HI failed");
|
|
goto err_sending;
|
|
}
|
|
|
|
ret = dce_send_set_addr_cmd_lo(d, wr_buff, 1);
|
|
if (ret) {
|
|
dce_err(d, "Sending of SEND_ADDR for READ IOVA LO failed");
|
|
goto err_sending;
|
|
}
|
|
#undef DCE_DATA_NBITS_SHIFT
|
|
|
|
err_sending:
|
|
return ret;
|
|
}
|
|
|
|
/**
|
|
* dce_send_get_fsize_cmd - Sends the "GET_FSIZE" command to dce fw
|
|
*
|
|
* @d : Pointer to tegra_dce struct
|
|
*
|
|
* Return : 0 if successful
|
|
*/
|
|
static int dce_send_get_fsize_cmd(struct tegra_dce *d)
|
|
{
|
|
u32 val;
|
|
int ret = 0;
|
|
|
|
val = DCE_BOOT_CMD_SET(0U, DCE_BOOT_CMD_GET_FSIZE);
|
|
|
|
ret = dce_mailbox_send_cmd_sync(d, val, DCE_MAILBOX_BOOT_INTERFACE);
|
|
|
|
return ret;
|
|
}
|
|
|
|
/**
|
|
* dce_send_set_nframes_cmd - Sends the "SET_NFRAMES" command to dce fw.
|
|
*
|
|
* @d : Pointer to tegra_dce struct
|
|
* @nframes : No. of frames
|
|
*
|
|
* Return : 0 if successful
|
|
*/
|
|
static int dce_send_set_nframes_cmd(struct tegra_dce *d, const u8 nframes)
|
|
{
|
|
u32 val;
|
|
int ret = 0;
|
|
|
|
val = DCE_BOOT_CMD_SET(0U, DCE_BOOT_CMD_SET_NFRAMES)
|
|
| DCE_BOOT_CMD_PARM_SET(0U, nframes);
|
|
|
|
ret = dce_mailbox_send_cmd_sync(d, val, DCE_MAILBOX_BOOT_INTERFACE);
|
|
|
|
return ret;
|
|
}
|
|
|
|
/**
|
|
* dce_send_set_frames_cmd - Sends the "SET_NFRAMES" command to dce fw.
|
|
*
|
|
* @d : Pointer to tegra_dce struct
|
|
* @nframes : No. of frames
|
|
*
|
|
* Retrun : 0 if successful
|
|
*/
|
|
static int dce_send_set_fsize_cmd(struct tegra_dce *d, const u32 fsize)
|
|
{
|
|
u32 val;
|
|
int ret = 0;
|
|
|
|
val = DCE_BOOT_CMD_SET(0U, DCE_BOOT_CMD_SET_FSIZE)
|
|
| DCE_BOOT_CMD_PARM_SET(0U, fsize);
|
|
|
|
ret = dce_mailbox_send_cmd_sync(d, val, DCE_MAILBOX_BOOT_INTERFACE);
|
|
|
|
return ret;
|
|
}
|
|
|
|
/**
|
|
* dce_send_channel_int_cmd - Sends the "CHANNEL_INIT" command to dce fw
|
|
*
|
|
* @d : Pointer to tegra_dce struct
|
|
*
|
|
* Return : 0 if successful
|
|
*/
|
|
static int dce_send_lock_cmd(struct tegra_dce *d)
|
|
{
|
|
u32 val;
|
|
int ret = 0;
|
|
|
|
val = DCE_BOOT_CMD_SET(0U, DCE_BOOT_CMD_LOCK);
|
|
|
|
ret = dce_mailbox_send_cmd_sync(d, val, DCE_MAILBOX_BOOT_INTERFACE);
|
|
|
|
return ret;
|
|
}
|
|
|
|
/**
|
|
* dce_bootstrap_send_ast_iova_info - Sends the iova info for AST
|
|
* channel.
|
|
*
|
|
* @d - Pointer to struct tegra_dce.
|
|
*
|
|
* Return : O if successful
|
|
*/
|
|
static int dce_bootstrap_send_ast_iova_info(struct tegra_dce *d)
|
|
{
|
|
u64 iova;
|
|
u32 size;
|
|
int ret = 0;
|
|
|
|
ret = dce_ipc_get_region_iova_info(d, &iova, &size);
|
|
if (ret) {
|
|
dce_err(d, "Failed to get the iova info needed for ast config");
|
|
goto err_sending;
|
|
}
|
|
|
|
#define DCE_DATA_NBITS_SHIFT 20
|
|
ret = dce_mailbox_send_cmd_sync(d,
|
|
DCE_BOOT_CMD_SET_HILO(0U, 1U) |
|
|
DCE_BOOT_CMD_SET(0U, DCE_BOOT_CMD_SET_AST_LENGTH) |
|
|
DCE_BOOT_CMD_PARM_SET(0U, size >> DCE_DATA_NBITS_SHIFT),
|
|
DCE_MAILBOX_BOOT_INTERFACE);
|
|
if (ret) {
|
|
dce_err(d, "Sending of bootstrap cmd SET_AST_LENGTH(HI) failed");
|
|
goto err_sending;
|
|
}
|
|
|
|
ret = dce_mailbox_send_cmd_sync(d,
|
|
DCE_BOOT_CMD_SET_HILO(0U, 0U) |
|
|
DCE_BOOT_CMD_SET(0U, DCE_BOOT_CMD_SET_AST_LENGTH) |
|
|
DCE_BOOT_CMD_PARM_SET(0U, size),
|
|
DCE_MAILBOX_BOOT_INTERFACE);
|
|
if (ret) {
|
|
dce_err(d, "Sending of bootstrap cmd SET_AST_LENGTH(LO) failed");
|
|
goto err_sending;
|
|
}
|
|
|
|
ret = dce_mailbox_send_cmd_sync(d,
|
|
DCE_BOOT_CMD_SET_HILO(0U, 1U) |
|
|
DCE_BOOT_CMD_SET(0U, DCE_BOOT_CMD_SET_AST_IOVA) |
|
|
DCE_BOOT_CMD_PARM_SET(0U, iova >> DCE_DATA_NBITS_SHIFT),
|
|
DCE_MAILBOX_BOOT_INTERFACE);
|
|
if (ret) {
|
|
dce_err(d, "Sending of bootstrap cmd SET_AST_IOVA(HI) failed");
|
|
goto err_sending;
|
|
}
|
|
#undef DCE_DATA_NBITS_SHIFT
|
|
|
|
ret = dce_mailbox_send_cmd_sync(d,
|
|
DCE_BOOT_CMD_SET_HILO(0U, 0U) |
|
|
DCE_BOOT_CMD_SET(0U, DCE_BOOT_CMD_SET_AST_IOVA) |
|
|
DCE_BOOT_CMD_PARM_SET(0U, iova),
|
|
DCE_MAILBOX_BOOT_INTERFACE);
|
|
if (ret) {
|
|
dce_err(d, "Sending of bootstrap cmd SET_AST_IOVA(LO) failed");
|
|
goto err_sending;
|
|
}
|
|
|
|
err_sending:
|
|
return ret;
|
|
}
|
|
|
|
/**
|
|
* dce_bootstrap_send_admin_ivc_info - Sends the ivc related info for admin
|
|
* channel.
|
|
*
|
|
* @d - Pointer to struct tegra_dce.
|
|
*
|
|
* Return : O if successful
|
|
*/
|
|
static int dce_bootstrap_send_admin_ivc_info(struct tegra_dce *d)
|
|
{
|
|
int ret = 0;
|
|
u32 val = 0;
|
|
|
|
struct dce_ipc_queue_info q_info;
|
|
|
|
ret = dce_admin_get_ipc_channel_info(d, &q_info);
|
|
if (ret) {
|
|
dce_err(d, "Failed to get the admin ivc channel info");
|
|
goto err_sending;
|
|
}
|
|
|
|
ret = dce_send_set_addr_read_cmd(d, (u64)(q_info.tx_iova));
|
|
if (ret) {
|
|
dce_err(d, "Sending of bootstrap cmd set_addr_read failed");
|
|
goto err_sending;
|
|
}
|
|
|
|
ret = dce_send_set_addr_write_cmd(d, (u64)(q_info.rx_iova));
|
|
if (ret) {
|
|
dce_err(d, "Sending of bootstrap cmd set_addr_write failed");
|
|
goto err_sending;
|
|
}
|
|
|
|
ret = dce_send_get_fsize_cmd(d);
|
|
if (ret) {
|
|
dce_err(d, "Sending of bootstrap cmd get_fsize failed");
|
|
goto err_sending;
|
|
}
|
|
|
|
/**
|
|
* It's assummed here that no other command is sent in between.
|
|
*/
|
|
val = dce_mailbox_get_interface_status(d,
|
|
DCE_MAILBOX_BOOT_INTERFACE);
|
|
|
|
ret = dce_send_set_nframes_cmd(d, q_info.nframes);
|
|
if (ret) {
|
|
dce_err(d, "Sending of bootstrap cmd set_nframes failed");
|
|
goto err_sending;
|
|
}
|
|
|
|
ret = dce_send_set_fsize_cmd(d, q_info.frame_sz);
|
|
if (ret) {
|
|
dce_err(d, "Sending of bootstrap cmd set_fsize failed");
|
|
goto err_sending;
|
|
}
|
|
|
|
err_sending:
|
|
return ret;
|
|
}
|
|
|
|
/**
|
|
* dce_start_bootstrap_flow - Starts sending the boostrap cmds to
|
|
* dce fw in the required sequence.
|
|
*
|
|
* @d : Pointer to tegra_dce struct
|
|
*
|
|
* Return : 0 if successful
|
|
*/
|
|
int dce_start_bootstrap_flow(struct tegra_dce *d)
|
|
{
|
|
u32 val;
|
|
int ret = 0;
|
|
|
|
d->boot_status |= DCE_FW_BOOTSTRAP_START;
|
|
ret = dce_send_version_cmd(d);
|
|
if (ret) {
|
|
dce_err(d, "Sending of bootstrap cmd VERSION failed");
|
|
goto err_sending;
|
|
}
|
|
/**
|
|
* It's assummed here that no other command is sent in between.
|
|
*/
|
|
val = dce_mailbox_get_interface_status(d,
|
|
DCE_MAILBOX_BOOT_INTERFACE);
|
|
|
|
ret = dce_send_set_sid_cmd(d);
|
|
if (ret) {
|
|
dce_err(d, "Sending of bootstrap cmd set_sid failed");
|
|
goto err_sending;
|
|
}
|
|
|
|
ret = dce_bootstrap_send_ast_iova_info(d);
|
|
if (ret) {
|
|
dce_err(d, "Sending of iova info failed");
|
|
goto err_sending;
|
|
}
|
|
|
|
ret = dce_bootstrap_send_admin_ivc_info(d);
|
|
if (ret) {
|
|
dce_err(d, "Sending of ivc channel info failedbootstrap cmd set_sid failed");
|
|
goto err_sending;
|
|
}
|
|
|
|
ret = dce_send_channel_int_cmd(d);
|
|
if (ret) {
|
|
dce_err(d, "Sending of bootstrap cmd channel_int failed");
|
|
goto err_sending;
|
|
}
|
|
|
|
ret = dce_send_lock_cmd(d);
|
|
if (ret) {
|
|
dce_err(d, "Sending of bootstrap cmd lock failed");
|
|
goto err_sending;
|
|
}
|
|
|
|
d->boot_status |= DCE_FW_BOOTSTRAP_DONE;
|
|
return 0;
|
|
|
|
err_sending:
|
|
dce_err(d, "Bootstrap process failed");
|
|
d->boot_status |= DCE_FW_BOOTSTRAP_FAILED;
|
|
return ret;
|
|
}
|