LXR linux/drivers/gpu/drm/nouveau/nvkm/subdev/bios/disp.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#include <subdev/bios.h>
  25#include <subdev/bios/bit.h>
  26#include <subdev/bios/disp.h>
  27
  28u16
  29nvbios_disp_table(struct nvkm_bios *bios,
  30                  u8 *ver, u8 *hdr, u8 *cnt, u8 *len, u8 *sub)
  31{
  32        struct bit_entry U;
  33
  34        if (!bit_entry(bios, 'U', &U)) {
  35                if (U.version == 1) {
  36                        u16 data = nvbios_rd16(bios, U.offset);
  37                        if (data) {
  38                                *ver = nvbios_rd08(bios, data + 0x00);
  39                                switch (*ver) {
  40                                case 0x20:
  41                                case 0x21:
  42                                case 0x22:
  43                                        *hdr = nvbios_rd08(bios, data + 0x01);
  44                                        *len = nvbios_rd08(bios, data + 0x02);
  45                                        *cnt = nvbios_rd08(bios, data + 0x03);
  46                                        *sub = nvbios_rd08(bios, data + 0x04);
  47                                        return data;
  48                                default:
  49                                        break;
  50                                }
  51                        }
  52                }
  53        }
  54
  55        return 0x0000;
  56}
  57
  58u16
  59nvbios_disp_entry(struct nvkm_bios *bios, u8 idx, u8 *ver, u8 *len, u8 *sub)
  60{
  61        u8  hdr, cnt;
  62        u16 data = nvbios_disp_table(bios, ver, &hdr, &cnt, len, sub);
  63        if (data && idx < cnt)
  64                return data + hdr + (idx * *len);
  65        *ver = 0x00;
  66        return 0x0000;
  67}
  68
  69u16
  70nvbios_disp_parse(struct nvkm_bios *bios, u8 idx, u8 *ver, u8 *len, u8 *sub,
  71                  struct nvbios_disp *info)
  72{
  73        u16 data = nvbios_disp_entry(bios, idx, ver, len, sub);
  74        if (data && *len >= 2) {
  75                info->data = nvbios_rd16(bios, data + 0);
  76                return data;
  77        }
  78        return 0x0000;
  79}
  80
  81u16
  82nvbios_outp_entry(struct nvkm_bios *bios, u8 idx,
  83                  u8 *ver, u8 *hdr, u8 *cnt, u8 *len)
  84{
  85        struct nvbios_disp info;
  86        u16 data = nvbios_disp_parse(bios, idx, ver, len, hdr, &info);
  87        if (data) {
  88                *cnt = nvbios_rd08(bios, info.data + 0x05);
  89                *len = 0x06;
  90                data = info.data;
  91        }
  92        return data;
  93}
  94
  95u16
  96nvbios_outp_parse(struct nvkm_bios *bios, u8 idx,
  97                  u8 *ver, u8 *hdr, u8 *cnt, u8 *len, struct nvbios_outp *info)
  98{
  99        u16 data = nvbios_outp_entry(bios, idx, ver, hdr, cnt, len);
 100        if (data && *hdr >= 0x0a) {
 101                info->type      = nvbios_rd16(bios, data + 0x00);
 102                info->mask      = nvbios_rd32(bios, data + 0x02);
 103                if (*ver <= 0x20) /* match any link */
 104                        info->mask |= 0x00c0;
 105                info->script[0] = nvbios_rd16(bios, data + 0x06);
 106                info->script[1] = nvbios_rd16(bios, data + 0x08);
 107                info->script[2] = 0x0000;
 108                if (*hdr >= 0x0c)
 109                        info->script[2] = nvbios_rd16(bios, data + 0x0a);
 110                return data;
 111        }
 112        return 0x0000;
 113}
 114
 115u16
 116nvbios_outp_match(struct nvkm_bios *bios, u16 type, u16 mask,
 117                  u8 *ver, u8 *hdr, u8 *cnt, u8 *len, struct nvbios_outp *info)
 118{
 119        u16 data, idx = 0;
 120        while ((data = nvbios_outp_parse(bios, idx++, ver, hdr, cnt, len, info)) || *ver) {
 121                if (data && info->type == type) {
 122                        if ((info->mask & mask) == mask)
 123                                break;
 124                }
 125        }
 126        return data;
 127}
 128
 129u16
 130nvbios_ocfg_entry(struct nvkm_bios *bios, u16 outp, u8 idx,
 131                  u8 *ver, u8 *hdr, u8 *cnt, u8 *len)
 132{
 133        if (idx < *cnt)
 134                return outp + *hdr + (idx * *len);
 135        return 0x0000;
 136}
 137
 138u16
 139nvbios_ocfg_parse(struct nvkm_bios *bios, u16 outp, u8 idx,
 140                  u8 *ver, u8 *hdr, u8 *cnt, u8 *len, struct nvbios_ocfg *info)
 141{
 142        u16 data = nvbios_ocfg_entry(bios, outp, idx, ver, hdr, cnt, len);
 143        if (data) {
 144                info->proto     = nvbios_rd08(bios, data + 0x00);
 145                info->flags     = nvbios_rd16(bios, data + 0x01);
 146                info->clkcmp[0] = nvbios_rd16(bios, data + 0x02);
 147                info->clkcmp[1] = nvbios_rd16(bios, data + 0x04);
 148        }
 149        return data;
 150}
 151
 152u16
 153nvbios_ocfg_match(struct nvkm_bios *bios, u16 outp, u8 proto, u8 flags,
 154                  u8 *ver, u8 *hdr, u8 *cnt, u8 *len, struct nvbios_ocfg *info)
 155{
 156        u16 data, idx = 0;
 157        while ((data = nvbios_ocfg_parse(bios, outp, idx++, ver, hdr, cnt, len, info))) {
 158                if ((info->proto == proto || info->proto == 0xff) &&
 159                    (info->flags == flags))
 160                        break;
 161        }
 162        return data;
 163}
 164
 165u16
 166nvbios_oclk_match(struct nvkm_bios *bios, u16 cmp, u32 khz)
 167{
 168        while (cmp) {
 169                if (khz / 10 >= nvbios_rd16(bios, cmp + 0x00))
 170                        return  nvbios_rd16(bios, cmp + 0x02);
 171                cmp += 0x04;
 172        }
 173        return 0x0000;
 174}
 175