From 60b715e85600a6be283e54c610c2a3db3b552059 Mon Sep 17 00:00:00 2001 From: Richard Zhao Date: Mon, 7 Mar 2016 14:23:12 -0800 Subject: gpu: nvgpu: vgpu: add fecs trace support Bug 1648908 Change-Id: I7901e7bce5f7aa124a188101dd0736241d87bd53 Signed-off-by: Richard Zhao Reviewed-on: http://git-master/r/1031861 Reviewed-on: http://git-master/r/1121261 Reviewed-by: Automatic_Commit_Validation_User Reviewed-by: Thomas Fleury Reviewed-by: Aingara Paramakuru GVS: Gerrit_Virtual_Submit Reviewed-by: Terje Bergstrom --- drivers/gpu/nvgpu/vgpu/fecs_trace_vgpu.c | 196 ++++++++++++++++++++++++++++++- 1 file changed, 195 insertions(+), 1 deletion(-) (limited to 'drivers/gpu/nvgpu/vgpu/fecs_trace_vgpu.c') diff --git a/drivers/gpu/nvgpu/vgpu/fecs_trace_vgpu.c b/drivers/gpu/nvgpu/vgpu/fecs_trace_vgpu.c index cb955811..568f3784 100644 --- a/drivers/gpu/nvgpu/vgpu/fecs_trace_vgpu.c +++ b/drivers/gpu/nvgpu/vgpu/fecs_trace_vgpu.c @@ -12,10 +12,204 @@ */ #include +#include +#include + #include "gk20a/gk20a.h" +#include "gk20a/ctxsw_trace_gk20a.h" +#include "vgpu.h" #include "fecs_trace_vgpu.h" +struct vgpu_fecs_trace { + struct tegra_hv_ivm_cookie *cookie; + struct nvgpu_ctxsw_ring_header *header; + struct nvgpu_ctxsw_trace_entry *entries; + int num_entries; + void *buf; +}; + +static int vgpu_fecs_trace_init(struct gk20a *g) +{ + struct device *dev = g->dev; + struct device_node *np = dev->of_node; + struct of_phandle_args args; + struct device_node *hv_np; + struct vgpu_fecs_trace *vcst; + u32 mempool; + int err; + + gk20a_dbg_fn(""); + + vcst = kzalloc(sizeof(*vcst), GFP_KERNEL); + if (!vcst) + return -ENOMEM; + + err = of_parse_phandle_with_fixed_args(np, + "mempool-fecs-trace", 1, 0, &args); + if (err) { + dev_info(dev_from_gk20a(g), "does not support fecs trace\n"); + goto fail; + } + + hv_np = args.np; + mempool = args.args[0]; + vcst->cookie = tegra_hv_mempool_reserve(hv_np, mempool); + if (IS_ERR(vcst->cookie)) { + dev_info(dev_from_gk20a(g), + "mempool %u reserve failed\n", mempool); + err = -EINVAL; + goto fail; + } + + vcst->buf = ioremap_cache(vcst->cookie->ipa, vcst->cookie->size); + vcst->header = vcst->buf; + vcst->num_entries = vcst->header->num_ents; + if (unlikely(vcst->header->ent_size != sizeof(*vcst->entries))) { + dev_err(dev_from_gk20a(g), + "entry size mismatch\n"); + goto fail; + } + vcst->entries = vcst->buf + sizeof(*vcst->header); + g->fecs_trace = (struct gk20a_fecs_trace *)vcst; + + return 0; +fail: + iounmap(vcst->buf); + if (vcst->cookie) + tegra_hv_mempool_unreserve(vcst->cookie); + kfree(vcst); + return err; +} + +static int vgpu_fecs_trace_deinit(struct gk20a *g) +{ + struct vgpu_fecs_trace *vcst = (struct vgpu_fecs_trace *)g->fecs_trace; + + iounmap(vcst->buf); + tegra_hv_mempool_unreserve(vcst->cookie); + kfree(vcst); + return 0; +} + +static int vgpu_fecs_trace_enable(struct gk20a *g) +{ + struct tegra_vgpu_cmd_msg msg = { + .cmd = TEGRA_VGPU_CMD_FECS_TRACE_ENABLE, + .handle = gk20a_get_platform(g->dev)->virt_handle, + }; + int err; + + err = vgpu_comm_sendrecv(&msg, sizeof(msg), sizeof(msg)); + err = err ? err : msg.ret; + WARN_ON(err); + return err; +} + +static int vgpu_fecs_trace_disable(struct gk20a *g) +{ + struct tegra_vgpu_cmd_msg msg = { + .cmd = TEGRA_VGPU_CMD_FECS_TRACE_DISABLE, + .handle = gk20a_get_platform(g->dev)->virt_handle, + }; + int err; + + err = vgpu_comm_sendrecv(&msg, sizeof(msg), sizeof(msg)); + err = err ? err : msg.ret; + WARN_ON(err); + return err; +} + +static int vgpu_fecs_trace_poll(struct gk20a *g) +{ + struct tegra_vgpu_cmd_msg msg = { + .cmd = TEGRA_VGPU_CMD_FECS_TRACE_POLL, + .handle = gk20a_get_platform(g->dev)->virt_handle, + }; + int err; + + err = vgpu_comm_sendrecv(&msg, sizeof(msg), sizeof(msg)); + err = err ? err : msg.ret; + WARN_ON(err); + return err; +} + +static int vgpu_alloc_user_buffer(struct gk20a *g, void **buf, size_t *size) +{ + struct vgpu_fecs_trace *vcst = (struct vgpu_fecs_trace *)g->fecs_trace; + + *buf = vcst->buf; + *size = vcst->cookie->size; + return 0; +} + +static int vgpu_free_user_buffer(struct gk20a *g) +{ + return 0; +} + +static int vgpu_mmap_user_buffer(struct gk20a *g, struct vm_area_struct *vma) +{ + struct vgpu_fecs_trace *vcst = (struct vgpu_fecs_trace *)g->fecs_trace; + unsigned long size = vcst->cookie->size; + unsigned long vsize = vma->vm_end - vma->vm_start; + + size = min(size, vsize); + size = round_up(size, PAGE_SIZE); + + return remap_pfn_range(vma, vma->vm_start, + vcst->cookie->ipa >> PAGE_SHIFT, + size, + vma->vm_page_prot); +} + +static int vgpu_fecs_trace_max_entries(struct gk20a *g, + struct nvgpu_ctxsw_trace_filter *filter) +{ + struct vgpu_fecs_trace *vcst = (struct vgpu_fecs_trace *)g->fecs_trace; + + return vcst->header->num_ents; +} + +#if NVGPU_CTXSW_FILTER_SIZE != TEGRA_VGPU_FECS_TRACE_FILTER_SIZE +#error "FECS trace filter size mismatch!" +#endif + +static int vgpu_fecs_trace_set_filter(struct gk20a *g, + struct nvgpu_ctxsw_trace_filter *filter) +{ + struct tegra_vgpu_cmd_msg msg = { + .cmd = TEGRA_VGPU_CMD_FECS_TRACE_SET_FILTER, + .handle = gk20a_get_platform(g->dev)->virt_handle, + }; + struct tegra_vgpu_fecs_trace_filter *p = &msg.params.fecs_trace_filter; + int err; + + memcpy(&p->tag_bits, &filter->tag_bits, sizeof(p->tag_bits)); + err = vgpu_comm_sendrecv(&msg, sizeof(msg), sizeof(msg)); + err = err ? err : msg.ret; + WARN_ON(err); + return err; +} + void vgpu_init_fecs_trace_ops(struct gpu_ops *ops) { - memset(&ops->fecs_trace, 0, sizeof(ops->fecs_trace)); + ops->fecs_trace.init = vgpu_fecs_trace_init; + ops->fecs_trace.deinit = vgpu_fecs_trace_deinit; + ops->fecs_trace.enable = vgpu_fecs_trace_enable; + ops->fecs_trace.disable = vgpu_fecs_trace_disable; + ops->fecs_trace.reset = NULL; + ops->fecs_trace.flush = NULL; + ops->fecs_trace.poll = vgpu_fecs_trace_poll; + ops->fecs_trace.bind_channel = NULL; + ops->fecs_trace.unbind_channel = NULL; + ops->fecs_trace.max_entries = vgpu_fecs_trace_max_entries; + ops->fecs_trace.alloc_user_buffer = vgpu_alloc_user_buffer; + ops->fecs_trace.free_user_buffer = vgpu_free_user_buffer; + ops->fecs_trace.mmap_user_buffer = vgpu_mmap_user_buffer; + ops->fecs_trace.set_filter = vgpu_fecs_trace_set_filter; +} + +void vgpu_fecs_trace_data_update(struct gk20a *g) +{ + gk20a_ctxsw_trace_wake_up(g, 0); } -- cgit v1.2.2