328 lines
8.9 KiB
C
328 lines
8.9 KiB
C
|
/*
|
||
|
|
* Tegra host1x Command DMA
|
||
|
|
*
|
||
|
|
* Copyright (c) 2010-2013, NVIDIA Corporation.
|
||
|
|
*
|
||
|
|
* This program is free software; you can redistribute it and/or modify it
|
||
|
|
* under the terms and conditions of the GNU General Public License,
|
||
|
|
* version 2, as published by the Free Software Foundation.
|
||
|
|
*
|
||
|
|
* This program is distributed in the hope it will be useful, but WITHOUT
|
||
|
|
* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
|
||
|
|
* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
|
||
|
|
* more details.
|
||
|
|
*
|
||
|
|
* You should have received a copy of the GNU General Public License
|
||
|
|
* along with this program. If not, see <http://www.gnu.org/licenses/>.
|
||
|
|
*/
|
||
|
|
|
||
|
|
#include <linux/slab.h>
|
||
|
|
#include <linux/scatterlist.h>
|
||
|
|
#include <linux/dma-mapping.h>
|
||
|
|
|
||
|
|
#include "../cdma.h"
|
||
|
|
#include "../channel.h"
|
||
|
|
#include "../dev.h"
|
||
|
|
#include "../debug.h"
|
||
|
|
|
||
|
|
/*
|
||
|
|
* Put the restart at the end of pushbuffer memory
|
||
|
|
*/
|
||
|
|
static void push_buffer_init(struct push_buffer *pb)
|
||
|
|
{
|
||
|
|
*(u32 *)(pb->mapped + pb->size_bytes) = host1x_opcode_restart(0);
|
||
|
|
}
|
||
|
|
|
||
|
|
/*
|
||
|
|
* Increment timedout buffer's syncpt via CPU.
|
||
|
|
*/
|
||
|
|
static void cdma_timeout_cpu_incr(struct host1x_cdma *cdma, u32 getptr,
|
||
|
|
u32 syncpt_incrs, u32 syncval, u32 nr_slots)
|
||
|
|
{
|
||
|
|
struct host1x *host1x = cdma_to_host1x(cdma);
|
||
|
|
struct push_buffer *pb = &cdma->push_buffer;
|
||
|
|
unsigned int i;
|
||
|
|
|
||
|
|
for (i = 0; i < syncpt_incrs; i++)
|
||
|
|
host1x_syncpt_incr(cdma->timeout.syncpt);
|
||
|
|
|
||
|
|
/* after CPU incr, ensure shadow is up to date */
|
||
|
|
host1x_syncpt_load(cdma->timeout.syncpt);
|
||
|
|
|
||
|
|
/* NOP all the PB slots */
|
||
|
|
while (nr_slots--) {
|
||
|
|
u32 *p = (u32 *)(pb->mapped + getptr);
|
||
|
|
*(p++) = HOST1X_OPCODE_NOP;
|
||
|
|
*(p++) = HOST1X_OPCODE_NOP;
|
||
|
|
dev_dbg(host1x->dev, "%s: NOP at %pad+%#x\n", __func__,
|
||
|
|
&pb->phys, getptr);
|
||
|
|
getptr = (getptr + 8) & (pb->size_bytes - 1);
|
||
|
|
}
|
||
|
|
|
||
|
|
wmb();
|
||
|
|
}
|
||
|
|
|
||
|
|
/*
|
||
|
|
* Start channel DMA
|
||
|
|
*/
|
||
|
|
static void cdma_start(struct host1x_cdma *cdma)
|
||
|
|
{
|
||
|
|
struct host1x_channel *ch = cdma_to_channel(cdma);
|
||
|
|
|
||
|
|
if (cdma->running)
|
||
|
|
return;
|
||
|
|
|
||
|
|
cdma->last_pos = cdma->push_buffer.pos;
|
||
|
|
|
||
|
|
host1x_ch_writel(ch, HOST1X_CHANNEL_DMACTRL_DMASTOP,
|
||
|
|
HOST1X_CHANNEL_DMACTRL);
|
||
|
|
|
||
|
|
/* set base, put and end pointer */
|
||
|
|
host1x_ch_writel(ch, cdma->push_buffer.phys, HOST1X_CHANNEL_DMASTART);
|
||
|
|
host1x_ch_writel(ch, cdma->push_buffer.pos, HOST1X_CHANNEL_DMAPUT);
|
||
|
|
host1x_ch_writel(ch, cdma->push_buffer.phys +
|
||
|
|
cdma->push_buffer.size_bytes + 4,
|
||
|
|
HOST1X_CHANNEL_DMAEND);
|
||
|
|
|
||
|
|
/* reset GET */
|
||
|
|
host1x_ch_writel(ch, HOST1X_CHANNEL_DMACTRL_DMASTOP |
|
||
|
|
HOST1X_CHANNEL_DMACTRL_DMAGETRST |
|
||
|
|
HOST1X_CHANNEL_DMACTRL_DMAINITGET,
|
||
|
|
HOST1X_CHANNEL_DMACTRL);
|
||
|
|
|
||
|
|
/* start the command DMA */
|
||
|
|
host1x_ch_writel(ch, 0, HOST1X_CHANNEL_DMACTRL);
|
||
|
|
|
||
|
|
cdma->running = true;
|
||
|
|
}
|
||
|
|
|
||
|
|
/*
|
||
|
|
* Similar to cdma_start(), but rather than starting from an idle
|
||
|
|
* state (where DMA GET is set to DMA PUT), on a timeout we restore
|
||
|
|
* DMA GET from an explicit value (so DMA may again be pending).
|
||
|
|
*/
|
||
|
|
static void cdma_timeout_restart(struct host1x_cdma *cdma, u32 getptr)
|
||
|
|
{
|
||
|
|
struct host1x *host1x = cdma_to_host1x(cdma);
|
||
|
|
struct host1x_channel *ch = cdma_to_channel(cdma);
|
||
|
|
|
||
|
|
if (cdma->running)
|
||
|
|
return;
|
||
|
|
|
||
|
|
cdma->last_pos = cdma->push_buffer.pos;
|
||
|
|
|
||
|
|
host1x_ch_writel(ch, HOST1X_CHANNEL_DMACTRL_DMASTOP,
|
||
|
|
HOST1X_CHANNEL_DMACTRL);
|
||
|
|
|
||
|
|
/* set base, end pointer (all of memory) */
|
||
|
|
host1x_ch_writel(ch, cdma->push_buffer.phys, HOST1X_CHANNEL_DMASTART);
|
||
|
|
host1x_ch_writel(ch, cdma->push_buffer.phys +
|
||
|
|
cdma->push_buffer.size_bytes,
|
||
|
|
HOST1X_CHANNEL_DMAEND);
|
||
|
|
|
||
|
|
/* set GET, by loading the value in PUT (then reset GET) */
|
||
|
|
host1x_ch_writel(ch, getptr, HOST1X_CHANNEL_DMAPUT);
|
||
|
|
host1x_ch_writel(ch, HOST1X_CHANNEL_DMACTRL_DMASTOP |
|
||
|
|
HOST1X_CHANNEL_DMACTRL_DMAGETRST |
|
||
|
|
HOST1X_CHANNEL_DMACTRL_DMAINITGET,
|
||
|
|
HOST1X_CHANNEL_DMACTRL);
|
||
|
|
|
||
|
|
dev_dbg(host1x->dev,
|
||
|
|
"%s: DMA GET 0x%x, PUT HW 0x%x / shadow 0x%x\n", __func__,
|
||
|
|
host1x_ch_readl(ch, HOST1X_CHANNEL_DMAGET),
|
||
|
|
host1x_ch_readl(ch, HOST1X_CHANNEL_DMAPUT),
|
||
|
|
cdma->last_pos);
|
||
|
|
|
||
|
|
/* deassert GET reset and set PUT */
|
||
|
|
host1x_ch_writel(ch, HOST1X_CHANNEL_DMACTRL_DMASTOP,
|
||
|
|
HOST1X_CHANNEL_DMACTRL);
|
||
|
|
host1x_ch_writel(ch, cdma->push_buffer.pos, HOST1X_CHANNEL_DMAPUT);
|
||
|
|
|
||
|
|
/* start the command DMA */
|
||
|
|
host1x_ch_writel(ch, 0, HOST1X_CHANNEL_DMACTRL);
|
||
|
|
|
||
|
|
cdma->running = true;
|
||
|
|
}
|
||
|
|
|
||
|
|
/*
|
||
|
|
* Kick channel DMA into action by writing its PUT offset (if it has changed)
|
||
|
|
*/
|
||
|
|
static void cdma_flush(struct host1x_cdma *cdma)
|
||
|
|
{
|
||
|
|
struct host1x_channel *ch = cdma_to_channel(cdma);
|
||
|
|
|
||
|
|
if (cdma->push_buffer.pos != cdma->last_pos) {
|
||
|
|
host1x_ch_writel(ch, cdma->push_buffer.pos,
|
||
|
|
HOST1X_CHANNEL_DMAPUT);
|
||
|
|
cdma->last_pos = cdma->push_buffer.pos;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
static void cdma_stop(struct host1x_cdma *cdma)
|
||
|
|
{
|
||
|
|
struct host1x_channel *ch = cdma_to_channel(cdma);
|
||
|
|
|
||
|
|
mutex_lock(&cdma->lock);
|
||
|
|
|
||
|
|
if (cdma->running) {
|
||
|
|
host1x_cdma_wait_locked(cdma, CDMA_EVENT_SYNC_QUEUE_EMPTY);
|
||
|
|
host1x_ch_writel(ch, HOST1X_CHANNEL_DMACTRL_DMASTOP,
|
||
|
|
HOST1X_CHANNEL_DMACTRL);
|
||
|
|
cdma->running = false;
|
||
|
|
}
|
||
|
|
|
||
|
|
mutex_unlock(&cdma->lock);
|
||
|
|
}
|
||
|
|
|
||
|
|
/*
|
||
|
|
* Stops both channel's command processor and CDMA immediately.
|
||
|
|
* Also, tears down the channel and resets corresponding module.
|
||
|
|
*/
|
||
|
|
static void cdma_freeze(struct host1x_cdma *cdma)
|
||
|
|
{
|
||
|
|
struct host1x *host = cdma_to_host1x(cdma);
|
||
|
|
struct host1x_channel *ch = cdma_to_channel(cdma);
|
||
|
|
u32 cmdproc_stop;
|
||
|
|
|
||
|
|
if (cdma->torndown && !cdma->running) {
|
||
|
|
dev_warn(host->dev, "Already torn down\n");
|
||
|
|
return;
|
||
|
|
}
|
||
|
|
|
||
|
|
dev_dbg(host->dev, "freezing channel (id %d)\n", ch->id);
|
||
|
|
|
||
|
|
cmdproc_stop = host1x_sync_readl(host, HOST1X_SYNC_CMDPROC_STOP);
|
||
|
|
cmdproc_stop |= BIT(ch->id);
|
||
|
|
host1x_sync_writel(host, cmdproc_stop, HOST1X_SYNC_CMDPROC_STOP);
|
||
|
|
|
||
|
|
dev_dbg(host->dev, "%s: DMA GET 0x%x, PUT HW 0x%x / shadow 0x%x\n",
|
||
|
|
__func__, host1x_ch_readl(ch, HOST1X_CHANNEL_DMAGET),
|
||
|
|
host1x_ch_readl(ch, HOST1X_CHANNEL_DMAPUT),
|
||
|
|
cdma->last_pos);
|
||
|
|
|
||
|
|
host1x_ch_writel(ch, HOST1X_CHANNEL_DMACTRL_DMASTOP,
|
||
|
|
HOST1X_CHANNEL_DMACTRL);
|
||
|
|
|
||
|
|
host1x_sync_writel(host, BIT(ch->id), HOST1X_SYNC_CH_TEARDOWN);
|
||
|
|
|
||
|
|
cdma->running = false;
|
||
|
|
cdma->torndown = true;
|
||
|
|
}
|
||
|
|
|
||
|
|
static void cdma_resume(struct host1x_cdma *cdma, u32 getptr)
|
||
|
|
{
|
||
|
|
struct host1x *host1x = cdma_to_host1x(cdma);
|
||
|
|
struct host1x_channel *ch = cdma_to_channel(cdma);
|
||
|
|
u32 cmdproc_stop;
|
||
|
|
|
||
|
|
dev_dbg(host1x->dev,
|
||
|
|
"resuming channel (id %u, DMAGET restart = 0x%x)\n",
|
||
|
|
ch->id, getptr);
|
||
|
|
|
||
|
|
cmdproc_stop = host1x_sync_readl(host1x, HOST1X_SYNC_CMDPROC_STOP);
|
||
|
|
cmdproc_stop &= ~BIT(ch->id);
|
||
|
|
host1x_sync_writel(host1x, cmdproc_stop, HOST1X_SYNC_CMDPROC_STOP);
|
||
|
|
|
||
|
|
cdma->torndown = false;
|
||
|
|
cdma_timeout_restart(cdma, getptr);
|
||
|
|
}
|
||
|
|
|
||
|
|
/*
|
||
|
|
* If this timeout fires, it indicates the current sync_queue entry has
|
||
|
|
* exceeded its TTL and the userctx should be timed out and remaining
|
||
|
|
* submits already issued cleaned up (future submits return an error).
|
||
|
|
*/
|
||
|
|
static void cdma_timeout_handler(struct work_struct *work)
|
||
|
|
{
|
||
|
|
u32 prev_cmdproc, cmdproc_stop, syncpt_val;
|
||
|
|
struct host1x_cdma *cdma;
|
||
|
|
struct host1x *host1x;
|
||
|
|
struct host1x_channel *ch;
|
||
|
|
|
||
|
|
cdma = container_of(to_delayed_work(work), struct host1x_cdma,
|
||
|
|
timeout.wq);
|
||
|
|
host1x = cdma_to_host1x(cdma);
|
||
|
|
ch = cdma_to_channel(cdma);
|
||
|
|
|
||
|
|
host1x_debug_dump(cdma_to_host1x(cdma));
|
||
|
|
|
||
|
|
mutex_lock(&cdma->lock);
|
||
|
|
|
||
|
|
if (!cdma->timeout.client) {
|
||
|
|
dev_dbg(host1x->dev,
|
||
|
|
"cdma_timeout: expired, but has no clientid\n");
|
||
|
|
mutex_unlock(&cdma->lock);
|
||
|
|
return;
|
||
|
|
}
|
||
|
|
|
||
|
|
/* stop processing to get a clean snapshot */
|
||
|
|
prev_cmdproc = host1x_sync_readl(host1x, HOST1X_SYNC_CMDPROC_STOP);
|
||
|
|
cmdproc_stop = prev_cmdproc | BIT(ch->id);
|
||
|
|
host1x_sync_writel(host1x, cmdproc_stop, HOST1X_SYNC_CMDPROC_STOP);
|
||
|
|
|
||
|
|
dev_dbg(host1x->dev, "cdma_timeout: cmdproc was 0x%x is 0x%x\n",
|
||
|
|
prev_cmdproc, cmdproc_stop);
|
||
|
|
|
||
|
|
syncpt_val = host1x_syncpt_load(cdma->timeout.syncpt);
|
||
|
|
|
||
|
|
/* has buffer actually completed? */
|
||
|
|
if ((s32)(syncpt_val - cdma->timeout.syncpt_val) >= 0) {
|
||
|
|
dev_dbg(host1x->dev,
|
||
|
|
"cdma_timeout: expired, but buffer had completed\n");
|
||
|
|
/* restore */
|
||
|
|
cmdproc_stop = prev_cmdproc & ~(BIT(ch->id));
|
||
|
|
host1x_sync_writel(host1x, cmdproc_stop,
|
||
|
|
HOST1X_SYNC_CMDPROC_STOP);
|
||
|
|
mutex_unlock(&cdma->lock);
|
||
|
|
return;
|
||
|
|
}
|
||
|
|
|
||
|
|
dev_warn(host1x->dev, "%s: timeout: %u (%s), HW thresh %d, done %d\n",
|
||
|
|
__func__, cdma->timeout.syncpt->id, cdma->timeout.syncpt->name,
|
||
|
|
syncpt_val, cdma->timeout.syncpt_val);
|
||
|
|
|
||
|
|
/* stop HW, resetting channel/module */
|
||
|
|
host1x_hw_cdma_freeze(host1x, cdma);
|
||
|
|
|
||
|
|
host1x_cdma_update_sync_queue(cdma, ch->dev);
|
||
|
|
mutex_unlock(&cdma->lock);
|
||
|
|
}
|
||
|
|
|
||
|
|
/*
|
||
|
|
* Init timeout resources
|
||
|
|
*/
|
||
|
|
static int cdma_timeout_init(struct host1x_cdma *cdma, unsigned int syncpt)
|
||
|
|
{
|
||
|
|
INIT_DELAYED_WORK(&cdma->timeout.wq, cdma_timeout_handler);
|
||
|
|
cdma->timeout.initialized = true;
|
||
|
|
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
/*
|
||
|
|
* Clean up timeout resources
|
||
|
|
*/
|
||
|
|
static void cdma_timeout_destroy(struct host1x_cdma *cdma)
|
||
|
|
{
|
||
|
|
if (cdma->timeout.initialized)
|
||
|
|
cancel_delayed_work(&cdma->timeout.wq);
|
||
|
|
|
||
|
|
cdma->timeout.initialized = false;
|
||
|
|
}
|
||
|
|
|
||
|
|
static const struct host1x_cdma_ops host1x_cdma_ops = {
|
||
|
|
.start = cdma_start,
|
||
|
|
.stop = cdma_stop,
|
||
|
|
.flush = cdma_flush,
|
||
|
|
|
||
|
|
.timeout_init = cdma_timeout_init,
|
||
|
|
.timeout_destroy = cdma_timeout_destroy,
|
||
|
|
.freeze = cdma_freeze,
|
||
|
|
.resume = cdma_resume,
|
||
|
|
.timeout_cpu_incr = cdma_timeout_cpu_incr,
|
||
|
|
};
|
||
|
|
|
||
|
|
static const struct host1x_pushbuffer_ops host1x_pushbuffer_ops = {
|
||
|
|
.init = push_buffer_init,
|
||
|
|
};
|