309 lines
		
	
	
		
			9.0 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			309 lines
		
	
	
		
			9.0 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
/*
 | 
						|
 * Copyright 2012 Red Hat Inc.
 | 
						|
 *
 | 
						|
 * 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 COPYRIGHT HOLDER(S) OR AUTHOR(S) 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.
 | 
						|
 *
 | 
						|
 * Authors: Ben Skeggs
 | 
						|
 */
 | 
						|
#include "changf100.h"
 | 
						|
 | 
						|
#include <core/client.h>
 | 
						|
#include <core/gpuobj.h>
 | 
						|
#include <subdev/fb.h>
 | 
						|
#include <subdev/timer.h>
 | 
						|
 | 
						|
#include <nvif/class.h>
 | 
						|
#include <nvif/cl906f.h>
 | 
						|
#include <nvif/unpack.h>
 | 
						|
 | 
						|
int
 | 
						|
gf100_fifo_chan_ntfy(struct nvkm_fifo_chan *chan, u32 type,
 | 
						|
		     struct nvkm_event **pevent)
 | 
						|
{
 | 
						|
	switch (type) {
 | 
						|
	case NV906F_V0_NTFY_NON_STALL_INTERRUPT:
 | 
						|
		*pevent = &chan->fifo->uevent;
 | 
						|
		return 0;
 | 
						|
	case NV906F_V0_NTFY_KILLED:
 | 
						|
		*pevent = &chan->fifo->kevent;
 | 
						|
		return 0;
 | 
						|
	default:
 | 
						|
		break;
 | 
						|
	}
 | 
						|
	return -EINVAL;
 | 
						|
}
 | 
						|
 | 
						|
static u32
 | 
						|
gf100_fifo_gpfifo_engine_addr(struct nvkm_engine *engine)
 | 
						|
{
 | 
						|
	switch (engine->subdev.type) {
 | 
						|
	case NVKM_ENGINE_SW    : return 0;
 | 
						|
	case NVKM_ENGINE_GR    : return 0x0210;
 | 
						|
	case NVKM_ENGINE_CE    : return 0x0230 + (engine->subdev.inst * 0x10);
 | 
						|
	case NVKM_ENGINE_MSPDEC: return 0x0250;
 | 
						|
	case NVKM_ENGINE_MSPPP : return 0x0260;
 | 
						|
	case NVKM_ENGINE_MSVLD : return 0x0270;
 | 
						|
	default:
 | 
						|
		WARN_ON(1);
 | 
						|
		return 0;
 | 
						|
	}
 | 
						|
}
 | 
						|
 | 
						|
static struct gf100_fifo_engn *
 | 
						|
gf100_fifo_gpfifo_engine(struct gf100_fifo_chan *chan, struct nvkm_engine *engine)
 | 
						|
{
 | 
						|
	int engi = chan->base.fifo->func->engine_id(chan->base.fifo, engine);
 | 
						|
	if (engi >= 0)
 | 
						|
		return &chan->engn[engi];
 | 
						|
	return NULL;
 | 
						|
}
 | 
						|
 | 
						|
static int
 | 
						|
gf100_fifo_gpfifo_engine_fini(struct nvkm_fifo_chan *base,
 | 
						|
			      struct nvkm_engine *engine, bool suspend)
 | 
						|
{
 | 
						|
	const u32 offset = gf100_fifo_gpfifo_engine_addr(engine);
 | 
						|
	struct gf100_fifo_chan *chan = gf100_fifo_chan(base);
 | 
						|
	struct nvkm_subdev *subdev = &chan->fifo->base.engine.subdev;
 | 
						|
	struct nvkm_device *device = subdev->device;
 | 
						|
	struct nvkm_gpuobj *inst = chan->base.inst;
 | 
						|
	int ret = 0;
 | 
						|
 | 
						|
	mutex_lock(&chan->fifo->base.mutex);
 | 
						|
	nvkm_wr32(device, 0x002634, chan->base.chid);
 | 
						|
	if (nvkm_msec(device, 2000,
 | 
						|
		if (nvkm_rd32(device, 0x002634) == chan->base.chid)
 | 
						|
			break;
 | 
						|
	) < 0) {
 | 
						|
		nvkm_error(subdev, "channel %d [%s] kick timeout\n",
 | 
						|
			   chan->base.chid, chan->base.object.client->name);
 | 
						|
		ret = -ETIMEDOUT;
 | 
						|
	}
 | 
						|
	mutex_unlock(&chan->fifo->base.mutex);
 | 
						|
 | 
						|
	if (ret && suspend)
 | 
						|
		return ret;
 | 
						|
 | 
						|
	if (offset) {
 | 
						|
		nvkm_kmap(inst);
 | 
						|
		nvkm_wo32(inst, offset + 0x00, 0x00000000);
 | 
						|
		nvkm_wo32(inst, offset + 0x04, 0x00000000);
 | 
						|
		nvkm_done(inst);
 | 
						|
	}
 | 
						|
 | 
						|
	return ret;
 | 
						|
}
 | 
						|
 | 
						|
static int
 | 
						|
gf100_fifo_gpfifo_engine_init(struct nvkm_fifo_chan *base,
 | 
						|
			      struct nvkm_engine *engine)
 | 
						|
{
 | 
						|
	const u32 offset = gf100_fifo_gpfifo_engine_addr(engine);
 | 
						|
	struct gf100_fifo_chan *chan = gf100_fifo_chan(base);
 | 
						|
	struct gf100_fifo_engn *engn = gf100_fifo_gpfifo_engine(chan, engine);
 | 
						|
	struct nvkm_gpuobj *inst = chan->base.inst;
 | 
						|
 | 
						|
	if (offset) {
 | 
						|
		nvkm_kmap(inst);
 | 
						|
		nvkm_wo32(inst, offset + 0x00, lower_32_bits(engn->vma->addr) | 4);
 | 
						|
		nvkm_wo32(inst, offset + 0x04, upper_32_bits(engn->vma->addr));
 | 
						|
		nvkm_done(inst);
 | 
						|
	}
 | 
						|
 | 
						|
	return 0;
 | 
						|
}
 | 
						|
 | 
						|
static void
 | 
						|
gf100_fifo_gpfifo_engine_dtor(struct nvkm_fifo_chan *base,
 | 
						|
			      struct nvkm_engine *engine)
 | 
						|
{
 | 
						|
	struct gf100_fifo_chan *chan = gf100_fifo_chan(base);
 | 
						|
	struct gf100_fifo_engn *engn = gf100_fifo_gpfifo_engine(chan, engine);
 | 
						|
	nvkm_vmm_put(chan->base.vmm, &engn->vma);
 | 
						|
	nvkm_gpuobj_del(&engn->inst);
 | 
						|
}
 | 
						|
 | 
						|
static int
 | 
						|
gf100_fifo_gpfifo_engine_ctor(struct nvkm_fifo_chan *base,
 | 
						|
			      struct nvkm_engine *engine,
 | 
						|
			      struct nvkm_object *object)
 | 
						|
{
 | 
						|
	struct gf100_fifo_chan *chan = gf100_fifo_chan(base);
 | 
						|
	struct gf100_fifo_engn *engn = gf100_fifo_gpfifo_engine(chan, engine);
 | 
						|
	int ret;
 | 
						|
 | 
						|
	if (!gf100_fifo_gpfifo_engine_addr(engine))
 | 
						|
		return 0;
 | 
						|
 | 
						|
	ret = nvkm_object_bind(object, NULL, 0, &engn->inst);
 | 
						|
	if (ret)
 | 
						|
		return ret;
 | 
						|
 | 
						|
	ret = nvkm_vmm_get(chan->base.vmm, 12, engn->inst->size, &engn->vma);
 | 
						|
	if (ret)
 | 
						|
		return ret;
 | 
						|
 | 
						|
	return nvkm_memory_map(engn->inst, 0, chan->base.vmm, engn->vma, NULL, 0);
 | 
						|
}
 | 
						|
 | 
						|
static void
 | 
						|
gf100_fifo_gpfifo_fini(struct nvkm_fifo_chan *base)
 | 
						|
{
 | 
						|
	struct gf100_fifo_chan *chan = gf100_fifo_chan(base);
 | 
						|
	struct gf100_fifo *fifo = chan->fifo;
 | 
						|
	struct nvkm_device *device = fifo->base.engine.subdev.device;
 | 
						|
	u32 coff = chan->base.chid * 8;
 | 
						|
 | 
						|
	if (!list_empty(&chan->head) && !chan->killed) {
 | 
						|
		gf100_fifo_runlist_remove(fifo, chan);
 | 
						|
		nvkm_mask(device, 0x003004 + coff, 0x00000001, 0x00000000);
 | 
						|
		gf100_fifo_runlist_commit(fifo);
 | 
						|
	}
 | 
						|
 | 
						|
	gf100_fifo_intr_engine(fifo);
 | 
						|
 | 
						|
	nvkm_wr32(device, 0x003000 + coff, 0x00000000);
 | 
						|
}
 | 
						|
 | 
						|
static void
 | 
						|
gf100_fifo_gpfifo_init(struct nvkm_fifo_chan *base)
 | 
						|
{
 | 
						|
	struct gf100_fifo_chan *chan = gf100_fifo_chan(base);
 | 
						|
	struct gf100_fifo *fifo = chan->fifo;
 | 
						|
	struct nvkm_device *device = fifo->base.engine.subdev.device;
 | 
						|
	u32 addr = chan->base.inst->addr >> 12;
 | 
						|
	u32 coff = chan->base.chid * 8;
 | 
						|
 | 
						|
	nvkm_wr32(device, 0x003000 + coff, 0xc0000000 | addr);
 | 
						|
 | 
						|
	if (list_empty(&chan->head) && !chan->killed) {
 | 
						|
		gf100_fifo_runlist_insert(fifo, chan);
 | 
						|
		nvkm_wr32(device, 0x003004 + coff, 0x001f0001);
 | 
						|
		gf100_fifo_runlist_commit(fifo);
 | 
						|
	}
 | 
						|
}
 | 
						|
 | 
						|
static void *
 | 
						|
gf100_fifo_gpfifo_dtor(struct nvkm_fifo_chan *base)
 | 
						|
{
 | 
						|
	return gf100_fifo_chan(base);
 | 
						|
}
 | 
						|
 | 
						|
static const struct nvkm_fifo_chan_func
 | 
						|
gf100_fifo_gpfifo_func = {
 | 
						|
	.dtor = gf100_fifo_gpfifo_dtor,
 | 
						|
	.init = gf100_fifo_gpfifo_init,
 | 
						|
	.fini = gf100_fifo_gpfifo_fini,
 | 
						|
	.ntfy = gf100_fifo_chan_ntfy,
 | 
						|
	.engine_ctor = gf100_fifo_gpfifo_engine_ctor,
 | 
						|
	.engine_dtor = gf100_fifo_gpfifo_engine_dtor,
 | 
						|
	.engine_init = gf100_fifo_gpfifo_engine_init,
 | 
						|
	.engine_fini = gf100_fifo_gpfifo_engine_fini,
 | 
						|
};
 | 
						|
 | 
						|
static int
 | 
						|
gf100_fifo_gpfifo_new(struct nvkm_fifo *base, const struct nvkm_oclass *oclass,
 | 
						|
		      void *data, u32 size, struct nvkm_object **pobject)
 | 
						|
{
 | 
						|
	union {
 | 
						|
		struct fermi_channel_gpfifo_v0 v0;
 | 
						|
	} *args = data;
 | 
						|
	struct gf100_fifo *fifo = gf100_fifo(base);
 | 
						|
	struct nvkm_object *parent = oclass->parent;
 | 
						|
	struct gf100_fifo_chan *chan;
 | 
						|
	u64 usermem, ioffset, ilength;
 | 
						|
	int ret = -ENOSYS, i;
 | 
						|
 | 
						|
	nvif_ioctl(parent, "create channel gpfifo size %d\n", size);
 | 
						|
	if (!(ret = nvif_unpack(ret, &data, &size, args->v0, 0, 0, false))) {
 | 
						|
		nvif_ioctl(parent, "create channel gpfifo vers %d vmm %llx "
 | 
						|
				   "ioffset %016llx ilength %08x\n",
 | 
						|
			   args->v0.version, args->v0.vmm, args->v0.ioffset,
 | 
						|
			   args->v0.ilength);
 | 
						|
		if (!args->v0.vmm)
 | 
						|
			return -EINVAL;
 | 
						|
	} else
 | 
						|
		return ret;
 | 
						|
 | 
						|
	/* allocate channel */
 | 
						|
	if (!(chan = kzalloc(sizeof(*chan), GFP_KERNEL)))
 | 
						|
		return -ENOMEM;
 | 
						|
	*pobject = &chan->base.object;
 | 
						|
	chan->fifo = fifo;
 | 
						|
	INIT_LIST_HEAD(&chan->head);
 | 
						|
 | 
						|
	ret = nvkm_fifo_chan_ctor(&gf100_fifo_gpfifo_func, &fifo->base,
 | 
						|
				  0x1000, 0x1000, true, args->v0.vmm, 0,
 | 
						|
				  BIT(GF100_FIFO_ENGN_GR) |
 | 
						|
				  BIT(GF100_FIFO_ENGN_MSPDEC) |
 | 
						|
				  BIT(GF100_FIFO_ENGN_MSPPP) |
 | 
						|
				  BIT(GF100_FIFO_ENGN_MSVLD) |
 | 
						|
				  BIT(GF100_FIFO_ENGN_CE0) |
 | 
						|
				  BIT(GF100_FIFO_ENGN_CE1) |
 | 
						|
				  BIT(GF100_FIFO_ENGN_SW),
 | 
						|
				  1, fifo->user.bar->addr, 0x1000,
 | 
						|
				  oclass, &chan->base);
 | 
						|
	if (ret)
 | 
						|
		return ret;
 | 
						|
 | 
						|
	args->v0.chid = chan->base.chid;
 | 
						|
 | 
						|
	/* clear channel control registers */
 | 
						|
 | 
						|
	usermem = chan->base.chid * 0x1000;
 | 
						|
	ioffset = args->v0.ioffset;
 | 
						|
	ilength = order_base_2(args->v0.ilength / 8);
 | 
						|
 | 
						|
	nvkm_kmap(fifo->user.mem);
 | 
						|
	for (i = 0; i < 0x1000; i += 4)
 | 
						|
		nvkm_wo32(fifo->user.mem, usermem + i, 0x00000000);
 | 
						|
	nvkm_done(fifo->user.mem);
 | 
						|
	usermem = nvkm_memory_addr(fifo->user.mem) + usermem;
 | 
						|
 | 
						|
	/* RAMFC */
 | 
						|
	nvkm_kmap(chan->base.inst);
 | 
						|
	nvkm_wo32(chan->base.inst, 0x08, lower_32_bits(usermem));
 | 
						|
	nvkm_wo32(chan->base.inst, 0x0c, upper_32_bits(usermem));
 | 
						|
	nvkm_wo32(chan->base.inst, 0x10, 0x0000face);
 | 
						|
	nvkm_wo32(chan->base.inst, 0x30, 0xfffff902);
 | 
						|
	nvkm_wo32(chan->base.inst, 0x48, lower_32_bits(ioffset));
 | 
						|
	nvkm_wo32(chan->base.inst, 0x4c, upper_32_bits(ioffset) |
 | 
						|
					 (ilength << 16));
 | 
						|
	nvkm_wo32(chan->base.inst, 0x54, 0x00000002);
 | 
						|
	nvkm_wo32(chan->base.inst, 0x84, 0x20400000);
 | 
						|
	nvkm_wo32(chan->base.inst, 0x94, 0x30000001);
 | 
						|
	nvkm_wo32(chan->base.inst, 0x9c, 0x00000100);
 | 
						|
	nvkm_wo32(chan->base.inst, 0xa4, 0x1f1f1f1f);
 | 
						|
	nvkm_wo32(chan->base.inst, 0xa8, 0x1f1f1f1f);
 | 
						|
	nvkm_wo32(chan->base.inst, 0xac, 0x0000001f);
 | 
						|
	nvkm_wo32(chan->base.inst, 0xb8, 0xf8000000);
 | 
						|
	nvkm_wo32(chan->base.inst, 0xf8, 0x10003080); /* 0x002310 */
 | 
						|
	nvkm_wo32(chan->base.inst, 0xfc, 0x10000010); /* 0x002350 */
 | 
						|
	nvkm_done(chan->base.inst);
 | 
						|
	return 0;
 | 
						|
}
 | 
						|
 | 
						|
const struct nvkm_fifo_chan_oclass
 | 
						|
gf100_fifo_gpfifo_oclass = {
 | 
						|
	.base.oclass = FERMI_CHANNEL_GPFIFO,
 | 
						|
	.base.minver = 0,
 | 
						|
	.base.maxver = 0,
 | 
						|
	.ctor = gf100_fifo_gpfifo_new,
 | 
						|
};
 |