kernel/drivers/gpu/drm/nouveau/nvkm/engine/disp/rootnv04.c

   1 /*
   2  * Copyright 2012 Red Hat Inc.
   3  *
   4  * Permission is hereby granted, free of charge, to any person obtaining a
   5  * copy of this software and associated documentation files (the "Software"),
   6  * to deal in the Software without restriction, including without limitation
   7  * the rights to use, copy, modify, merge, publish, distribute, sublicense,
   8  * and/or sell copies of the Software, and to permit persons to whom the
   9  * Software is furnished to do so, subject to the following conditions:
  10  *
  11  * The above copyright notice and this permission notice shall be included in
  12  * all copies or substantial portions of the Software.
  13  *
  14  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
  15  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
  16  * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.  IN NO EVENT SHALL
  17  * THE COPYRIGHT HOLDER(S) OR AUTHOR(S) BE LIABLE FOR ANY CLAIM, DAMAGES OR
  18  * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE,
  19  * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
  20  * OTHER DEALINGS IN THE SOFTWARE.
  21  *
  22  * Authors: Ben Skeggs
  23  */
  24 #define nv04_disp_root(p) container_of((p), struct nv04_disp_root, object)
  25 #include "priv.h"
  26
  27 #include <core/client.h>
  28
  29 #include <nvif/class.h>
  30 #include <nvif/unpack.h>
  31
  32 struct nv04_disp_root {
  33         struct nvkm_object object;
  34         struct nvkm_disp *disp;
  35 };
  36
  37 static int
  38 nv04_disp_scanoutpos(struct nv04_disp_root *root,
  39                      void *data, u32 size, int head)
  40 {
  41         struct nvkm_device *device = root->disp->engine.subdev.device;
  42         struct nvkm_object *object = &root->object;
  43         const u32 hoff = head * 0x2000;
  44         union {
  45                 struct nv04_disp_scanoutpos_v0 v0;
  46         } *args = data;
  47         u32 line;
  48         int ret;
  49
  50         nvif_ioctl(object, "disp scanoutpos size %d\n", size);
  51         if (nvif_unpack(args->v0, 0, 0, false)) {
  52                 nvif_ioctl(object, "disp scanoutpos vers %d\n",
  53                            args->v0.version);
  54                 args->v0.vblanks = nvkm_rd32(device, 0x680800 + hoff) & 0xffff;
  55                 args->v0.vtotal  = nvkm_rd32(device, 0x680804 + hoff) & 0xffff;
  56                 args->v0.vblanke = args->v0.vtotal - 1;
  57
  58                 args->v0.hblanks = nvkm_rd32(device, 0x680820 + hoff) & 0xffff;
  59                 args->v0.htotal  = nvkm_rd32(device, 0x680824 + hoff) & 0xffff;
  60                 args->v0.hblanke = args->v0.htotal - 1;
  61
  62                 /*
  63                  * If output is vga instead of digital then vtotal/htotal is
  64                  * invalid so we have to give up and trigger the timestamping
  65                  * fallback in the drm core.
  66                  */
  67                 if (!args->v0.vtotal || !args->v0.htotal)
  68                         return -ENOTSUPP;
  69
  70                 args->v0.time[0] = ktime_to_ns(ktime_get());
  71                 line = nvkm_rd32(device, 0x600868 + hoff);
  72                 args->v0.time[1] = ktime_to_ns(ktime_get());
  73                 args->v0.hline = (line & 0xffff0000) >> 16;
  74                 args->v0.vline = (line & 0x0000ffff);
  75         } else
  76                 return ret;
  77
  78         return 0;
  79 }
  80
  81 static int
  82 nv04_disp_mthd(struct nvkm_object *object, u32 mthd, void *data, u32 size)
  83 {
  84         struct nv04_disp_root *root = nv04_disp_root(object);
  85         union {
  86                 struct nv04_disp_mthd_v0 v0;
  87         } *args = data;
  88         int head, ret;
  89
  90         nvif_ioctl(object, "disp mthd size %d\n", size);
  91         if (nvif_unpack(args->v0, 0, 0, true)) {
  92                 nvif_ioctl(object, "disp mthd vers %d mthd %02x head %d\n",
  93                            args->v0.version, args->v0.method, args->v0.head);
  94                 mthd = args->v0.method;
  95                 head = args->v0.head;
  96         } else
  97                 return ret;
  98
  99         if (head < 0 || head >= 2)
 100                 return -ENXIO;
 101
 102         switch (mthd) {
 103         case NV04_DISP_SCANOUTPOS:
 104                 return nv04_disp_scanoutpos(root, data, size, head);
 105         default:
 106                 break;
 107         }
 108
 109         return -EINVAL;
 110 }
 111
 112 static const struct nvkm_object_func
 113 nv04_disp_root = {
 114         .mthd = nv04_disp_mthd,
 115         .ntfy = nvkm_disp_ntfy,
 116 };
 117
 118 static int
 119 nv04_disp_root_new(struct nvkm_disp *disp, const struct nvkm_oclass *oclass,
 120                    void *data, u32 size, struct nvkm_object **pobject)
 121 {
 122         struct nv04_disp_root *root;
 123
 124         if (!(root = kzalloc(sizeof(*root), GFP_KERNEL)))
 125                 return -ENOMEM;
 126         root->disp = disp;
 127         *pobject = &root->object;
 128
 129         nvkm_object_ctor(&nv04_disp_root, oclass, &root->object);
 130         return 0;
 131 }
 132
 133 const struct nvkm_disp_oclass
 134 nv04_disp_root_oclass = {
 135         .base.oclass = NV04_DISP,
 136         .base.minver = -1,
 137         .base.maxver = -1,
 138         .ctor = nv04_disp_root_new,
 139 };