drivers/gpu/drm/nouveau/core/subdev/bios/gpio.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
  25 #include <subdev/bios.h>
  26 #include <subdev/bios/dcb.h>
  27 #include <subdev/bios/gpio.h>
  28
  29 u16
  30 dcb_gpio_table(struct nouveau_bios *bios)
  31 {
  32         u8  ver, hdr, cnt, len;
  33         u16 dcb = dcb_table(bios, &ver, &hdr, &cnt, &len);
  34         if (dcb) {
  35                 if (ver >= 0x30 && hdr >= 0x0c)
  36                         return nv_ro16(bios, dcb + 0x0a);
  37                 if (ver >= 0x22 && nv_ro08(bios, dcb - 1) >= 0x13)
  38                         return nv_ro16(bios, dcb - 0x0f);
  39         }
  40         return 0x0000;
  41 }
  42
  43 u16
  44 dcb_gpio_entry(struct nouveau_bios *bios, int idx, int ent, u8 *ver)
  45 {
  46         u16 gpio = dcb_gpio_table(bios);
  47         if (gpio) {
  48                 *ver = nv_ro08(bios, gpio);
  49                 if (*ver < 0x30 && ent < nv_ro08(bios, gpio + 2))
  50                         return gpio + 3 + (ent * nv_ro08(bios, gpio + 1));
  51                 else if (ent < nv_ro08(bios, gpio + 2))
  52                         return gpio + nv_ro08(bios, gpio + 1) +
  53                                (ent * nv_ro08(bios, gpio + 3));
  54         }
  55         return 0x0000;
  56 }
  57
  58 int
  59 dcb_gpio_parse(struct nouveau_bios *bios, int idx, u8 func, u8 line,
  60                struct dcb_gpio_func *gpio)
  61 {
  62         u8  ver, hdr, cnt, len;
  63         u16 entry;
  64         int i = -1;
  65
  66         while ((entry = dcb_gpio_entry(bios, idx, ++i, &ver))) {
  67                 if (ver < 0x40) {
  68                         u16 data = nv_ro16(bios, entry);
  69                         *gpio = (struct dcb_gpio_func) {
  70                                 .line = (data & 0x001f) >> 0,
  71                                 .func = (data & 0x07e0) >> 5,
  72                                 .log[0] = (data & 0x1800) >> 11,
  73                                 .log[1] = (data & 0x6000) >> 13,
  74                                 .param = !!(data & 0x8000),
  75                         };
  76                 } else
  77                 if (ver < 0x41) {
  78                         u32 data = nv_ro32(bios, entry);
  79                         *gpio = (struct dcb_gpio_func) {
  80                                 .line = (data & 0x0000001f) >> 0,
  81                                 .func = (data & 0x0000ff00) >> 8,
  82                                 .log[0] = (data & 0x18000000) >> 27,
  83                                 .log[1] = (data & 0x60000000) >> 29,
  84                                 .param = !!(data & 0x80000000),
  85                         };
  86                 } else {
  87                         u32 data = nv_ro32(bios, entry + 0);
  88                         u8 data1 = nv_ro32(bios, entry + 4);
  89                         *gpio = (struct dcb_gpio_func) {
  90                                 .line = (data & 0x0000003f) >> 0,
  91                                 .func = (data & 0x0000ff00) >> 8,
  92                                 .log[0] = (data1 & 0x30) >> 4,
  93                                 .log[1] = (data1 & 0xc0) >> 6,
  94                                 .param = !!(data & 0x80000000),
  95                         };
  96                 }
  97
  98                 if ((line == 0xff || line == gpio->line) &&
  99                     (func == 0xff || func == gpio->func))
 100                         return 0;
 101         }
 102
 103         /* DCB 2.2, fixed TVDAC GPIO data */
 104         if ((entry = dcb_table(bios, &ver, &hdr, &cnt, &len))) {
 105                 if (ver >= 0x22 && ver < 0x30 && func == DCB_GPIO_TVDAC0) {
 106                         u8 conf = nv_ro08(bios, entry - 5);
 107                         u8 addr = nv_ro08(bios, entry - 4);
 108                         if (conf & 0x01) {
 109                                 *gpio = (struct dcb_gpio_func) {
 110                                         .func = DCB_GPIO_TVDAC0,
 111                                         .line = addr >> 4,
 112                                         .log[0] = !!(conf & 0x02),
 113                                         .log[1] =  !(conf & 0x02),
 114                                 };
 115                                 return 0;
 116                         }
 117                 }
 118         }
 119
 120         return -EINVAL;
 121 }