mirror of
git://nv-tegra.nvidia.com/linux-nvgpu.git
synced 2025-12-22 09:12:24 +03:00
144 lines
3.7 KiB
C
144 lines
3.7 KiB
C
/*
|
|
* Copyright (c) 2018-2019, NVIDIA CORPORATION. All rights reserved.
|
|
*
|
|
* Permission is hereby granted, free of charge, to any person obtaining a
|
|
* copy of this software and associated documentation files (the "Software"),
|
|
* to deal in the Software without restriction, including without limitation
|
|
* the rights to use, copy, modify, merge, publish, distribute, sublicense,
|
|
* and/or sell copies of the Software, and to permit persons to whom the
|
|
* Software is furnished to do so, subject to the following conditions:
|
|
*
|
|
* The above copyright notice and this permission notice shall be included in
|
|
* all copies or substantial portions of the Software.
|
|
*
|
|
* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
|
|
* IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
|
|
* FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
|
|
* THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
|
|
* LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING
|
|
* FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER
|
|
* DEALINGS IN THE SOFTWARE.
|
|
*/
|
|
|
|
#include <nvgpu/gk20a.h>
|
|
#include <nvgpu/pmu.h>
|
|
#include <nvgpu/log.h>
|
|
#include <nvgpu/sec2/sec2.h>
|
|
#include <nvgpu/sec2/queue.h>
|
|
#include <nvgpu/sec2/cmd.h>
|
|
|
|
/* command post operation functions */
|
|
static bool sec2_validate_cmd(struct nvgpu_sec2 *sec2,
|
|
struct nv_flcn_cmd_sec2 *cmd, u32 queue_id)
|
|
{
|
|
struct gk20a *g = sec2->g;
|
|
u32 queue_size;
|
|
|
|
if (queue_id != SEC2_NV_CMDQ_LOG_ID) {
|
|
goto invalid_cmd;
|
|
}
|
|
|
|
if (cmd->hdr.size < PMU_CMD_HDR_SIZE) {
|
|
goto invalid_cmd;
|
|
}
|
|
|
|
queue_size = nvgpu_sec2_queue_get_size(sec2->queues, queue_id);
|
|
|
|
if (cmd->hdr.size > (queue_size >> 1)) {
|
|
goto invalid_cmd;
|
|
}
|
|
|
|
if (!NV_SEC2_UNITID_IS_VALID(cmd->hdr.unit_id)) {
|
|
goto invalid_cmd;
|
|
}
|
|
|
|
return true;
|
|
|
|
invalid_cmd:
|
|
nvgpu_err(g, "invalid sec2 cmd :");
|
|
nvgpu_err(g, "queue_id=%d, cmd_size=%d, cmd_unit_id=%d\n",
|
|
queue_id, cmd->hdr.size, cmd->hdr.unit_id);
|
|
|
|
return false;
|
|
}
|
|
|
|
static int sec2_write_cmd(struct nvgpu_sec2 *sec2,
|
|
struct nv_flcn_cmd_sec2 *cmd, u32 queue_id,
|
|
u32 timeout_ms)
|
|
{
|
|
struct nvgpu_timeout timeout;
|
|
struct gk20a *g = sec2->g;
|
|
int err;
|
|
|
|
nvgpu_log_fn(g, " ");
|
|
|
|
nvgpu_timeout_init(g, &timeout, timeout_ms, NVGPU_TIMER_CPU_TIMER);
|
|
|
|
do {
|
|
err = nvgpu_sec2_queue_push(sec2->queues, queue_id, &sec2->flcn,
|
|
cmd, cmd->hdr.size);
|
|
if ((err == -EAGAIN) &&
|
|
(nvgpu_timeout_expired(&timeout) == 0)) {
|
|
nvgpu_usleep_range(1000U, 2000U);
|
|
} else {
|
|
break;
|
|
}
|
|
} while (true);
|
|
|
|
if (err != 0) {
|
|
nvgpu_err(g, "fail to write cmd to queue %d", queue_id);
|
|
}
|
|
|
|
return err;
|
|
}
|
|
|
|
int nvgpu_sec2_cmd_post(struct gk20a *g, struct nv_flcn_cmd_sec2 *cmd,
|
|
u32 queue_id, sec2_callback callback,
|
|
void *cb_param, u32 timeout)
|
|
{
|
|
struct nvgpu_sec2 *sec2 = &g->sec2;
|
|
struct sec2_sequence *seq = NULL;
|
|
int err = 0;
|
|
|
|
if ((cmd == NULL) || (!sec2->sec2_ready)) {
|
|
if (cmd == NULL) {
|
|
nvgpu_warn(g,
|
|
"%s(): SEC2 cmd buffer is NULL", __func__);
|
|
} else {
|
|
nvgpu_warn(g, "%s(): SEC2 is not ready", __func__);
|
|
}
|
|
|
|
err = -EINVAL;
|
|
goto exit;
|
|
}
|
|
|
|
/* Sanity check the command input. */
|
|
if (!sec2_validate_cmd(sec2, cmd, queue_id)) {
|
|
err = -EINVAL;
|
|
goto exit;
|
|
}
|
|
|
|
/* Attempt to reserve a sequence for this command. */
|
|
err = nvgpu_sec2_seq_acquire(g, &sec2->sequences, &seq,
|
|
callback, cb_param);
|
|
if (err != 0) {
|
|
goto exit;
|
|
}
|
|
|
|
/* Set the sequence number in the command header. */
|
|
cmd->hdr.seq_id = nvgpu_sec2_seq_get_id(seq);
|
|
|
|
cmd->hdr.ctrl_flags = 0U;
|
|
cmd->hdr.ctrl_flags = PMU_CMD_FLAGS_STATUS;
|
|
|
|
nvgpu_sec2_seq_set_state(seq, SEC2_SEQ_STATE_USED);
|
|
|
|
err = sec2_write_cmd(sec2, cmd, queue_id, timeout);
|
|
if (err != 0) {
|
|
nvgpu_sec2_seq_set_state(seq, SEC2_SEQ_STATE_PENDING);
|
|
}
|
|
|
|
exit:
|
|
return err;
|
|
}
|