1c39f472eSBen Skeggs /* 2c39f472eSBen Skeggs * Copyright 2012 Red Hat Inc. 3c39f472eSBen Skeggs * 4c39f472eSBen Skeggs * Permission is hereby granted, free of charge, to any person obtaining a 5c39f472eSBen Skeggs * copy of this software and associated documentation files (the "Software"), 6c39f472eSBen Skeggs * to deal in the Software without restriction, including without limitation 7c39f472eSBen Skeggs * the rights to use, copy, modify, merge, publish, distribute, sublicense, 8c39f472eSBen Skeggs * and/or sell copies of the Software, and to permit persons to whom the 9c39f472eSBen Skeggs * Software is furnished to do so, subject to the following conditions: 10c39f472eSBen Skeggs * 11c39f472eSBen Skeggs * The above copyright notice and this permission notice shall be included in 12c39f472eSBen Skeggs * all copies or substantial portions of the Software. 13c39f472eSBen Skeggs * 14c39f472eSBen Skeggs * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR 15c39f472eSBen Skeggs * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, 16c39f472eSBen Skeggs * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL 17c39f472eSBen Skeggs * THE COPYRIGHT HOLDER(S) OR AUTHOR(S) BE LIABLE FOR ANY CLAIM, DAMAGES OR 18c39f472eSBen Skeggs * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, 19c39f472eSBen Skeggs * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR 20c39f472eSBen Skeggs * OTHER DEALINGS IN THE SOFTWARE. 21c39f472eSBen Skeggs * 22c39f472eSBen Skeggs * Authors: Ben Skeggs 23c39f472eSBen Skeggs */ 24c39f472eSBen Skeggs 25c39f472eSBen Skeggs #include <core/subdev.h> 26c39f472eSBen Skeggs #include <core/device.h> 27c39f472eSBen Skeggs #include <subdev/vga.h> 28c39f472eSBen Skeggs 29c39f472eSBen Skeggs u8 30c39f472eSBen Skeggs nv_rdport(void *obj, int head, u16 port) 31c39f472eSBen Skeggs { 32c39f472eSBen Skeggs struct nouveau_device *device = nv_device(obj); 33c39f472eSBen Skeggs 34c39f472eSBen Skeggs if (device->card_type >= NV_50) 35c39f472eSBen Skeggs return nv_rd08(obj, 0x601000 + port); 36c39f472eSBen Skeggs 37c39f472eSBen Skeggs if (port == 0x03c0 || port == 0x03c1 || /* AR */ 38c39f472eSBen Skeggs port == 0x03c2 || port == 0x03da || /* INP0 */ 39c39f472eSBen Skeggs port == 0x03d4 || port == 0x03d5) /* CR */ 40c39f472eSBen Skeggs return nv_rd08(obj, 0x601000 + (head * 0x2000) + port); 41c39f472eSBen Skeggs 42c39f472eSBen Skeggs if (port == 0x03c2 || port == 0x03cc || /* MISC */ 43c39f472eSBen Skeggs port == 0x03c4 || port == 0x03c5 || /* SR */ 44c39f472eSBen Skeggs port == 0x03ce || port == 0x03cf) { /* GR */ 45c39f472eSBen Skeggs if (device->card_type < NV_40) 46c39f472eSBen Skeggs head = 0; /* CR44 selects head */ 47c39f472eSBen Skeggs return nv_rd08(obj, 0x0c0000 + (head * 0x2000) + port); 48c39f472eSBen Skeggs } 49c39f472eSBen Skeggs 50c39f472eSBen Skeggs nv_error(obj, "unknown vga port 0x%04x\n", port); 51c39f472eSBen Skeggs return 0x00; 52c39f472eSBen Skeggs } 53c39f472eSBen Skeggs 54c39f472eSBen Skeggs void 55c39f472eSBen Skeggs nv_wrport(void *obj, int head, u16 port, u8 data) 56c39f472eSBen Skeggs { 57c39f472eSBen Skeggs struct nouveau_device *device = nv_device(obj); 58c39f472eSBen Skeggs 59c39f472eSBen Skeggs if (device->card_type >= NV_50) 60c39f472eSBen Skeggs nv_wr08(obj, 0x601000 + port, data); 61c39f472eSBen Skeggs else 62c39f472eSBen Skeggs if (port == 0x03c0 || port == 0x03c1 || /* AR */ 63c39f472eSBen Skeggs port == 0x03c2 || port == 0x03da || /* INP0 */ 64c39f472eSBen Skeggs port == 0x03d4 || port == 0x03d5) /* CR */ 65c39f472eSBen Skeggs nv_wr08(obj, 0x601000 + (head * 0x2000) + port, data); 66c39f472eSBen Skeggs else 67c39f472eSBen Skeggs if (port == 0x03c2 || port == 0x03cc || /* MISC */ 68c39f472eSBen Skeggs port == 0x03c4 || port == 0x03c5 || /* SR */ 69c39f472eSBen Skeggs port == 0x03ce || port == 0x03cf) { /* GR */ 70c39f472eSBen Skeggs if (device->card_type < NV_40) 71c39f472eSBen Skeggs head = 0; /* CR44 selects head */ 72c39f472eSBen Skeggs nv_wr08(obj, 0x0c0000 + (head * 0x2000) + port, data); 73c39f472eSBen Skeggs } else 74c39f472eSBen Skeggs nv_error(obj, "unknown vga port 0x%04x\n", port); 75c39f472eSBen Skeggs } 76c39f472eSBen Skeggs 77c39f472eSBen Skeggs u8 78c39f472eSBen Skeggs nv_rdvgas(void *obj, int head, u8 index) 79c39f472eSBen Skeggs { 80c39f472eSBen Skeggs nv_wrport(obj, head, 0x03c4, index); 81c39f472eSBen Skeggs return nv_rdport(obj, head, 0x03c5); 82c39f472eSBen Skeggs } 83c39f472eSBen Skeggs 84c39f472eSBen Skeggs void 85c39f472eSBen Skeggs nv_wrvgas(void *obj, int head, u8 index, u8 value) 86c39f472eSBen Skeggs { 87c39f472eSBen Skeggs nv_wrport(obj, head, 0x03c4, index); 88c39f472eSBen Skeggs nv_wrport(obj, head, 0x03c5, value); 89c39f472eSBen Skeggs } 90c39f472eSBen Skeggs 91c39f472eSBen Skeggs u8 92c39f472eSBen Skeggs nv_rdvgag(void *obj, int head, u8 index) 93c39f472eSBen Skeggs { 94c39f472eSBen Skeggs nv_wrport(obj, head, 0x03ce, index); 95c39f472eSBen Skeggs return nv_rdport(obj, head, 0x03cf); 96c39f472eSBen Skeggs } 97c39f472eSBen Skeggs 98c39f472eSBen Skeggs void 99c39f472eSBen Skeggs nv_wrvgag(void *obj, int head, u8 index, u8 value) 100c39f472eSBen Skeggs { 101c39f472eSBen Skeggs nv_wrport(obj, head, 0x03ce, index); 102c39f472eSBen Skeggs nv_wrport(obj, head, 0x03cf, value); 103c39f472eSBen Skeggs } 104c39f472eSBen Skeggs 105c39f472eSBen Skeggs u8 106c39f472eSBen Skeggs nv_rdvgac(void *obj, int head, u8 index) 107c39f472eSBen Skeggs { 108c39f472eSBen Skeggs nv_wrport(obj, head, 0x03d4, index); 109c39f472eSBen Skeggs return nv_rdport(obj, head, 0x03d5); 110c39f472eSBen Skeggs } 111c39f472eSBen Skeggs 112c39f472eSBen Skeggs void 113c39f472eSBen Skeggs nv_wrvgac(void *obj, int head, u8 index, u8 value) 114c39f472eSBen Skeggs { 115c39f472eSBen Skeggs nv_wrport(obj, head, 0x03d4, index); 116c39f472eSBen Skeggs nv_wrport(obj, head, 0x03d5, value); 117c39f472eSBen Skeggs } 118c39f472eSBen Skeggs 119c39f472eSBen Skeggs u8 120c39f472eSBen Skeggs nv_rdvgai(void *obj, int head, u16 port, u8 index) 121c39f472eSBen Skeggs { 122c39f472eSBen Skeggs if (port == 0x03c4) return nv_rdvgas(obj, head, index); 123c39f472eSBen Skeggs if (port == 0x03ce) return nv_rdvgag(obj, head, index); 124c39f472eSBen Skeggs if (port == 0x03d4) return nv_rdvgac(obj, head, index); 125c39f472eSBen Skeggs nv_error(obj, "unknown indexed vga port 0x%04x\n", port); 126c39f472eSBen Skeggs return 0x00; 127c39f472eSBen Skeggs } 128c39f472eSBen Skeggs 129c39f472eSBen Skeggs void 130c39f472eSBen Skeggs nv_wrvgai(void *obj, int head, u16 port, u8 index, u8 value) 131c39f472eSBen Skeggs { 132c39f472eSBen Skeggs if (port == 0x03c4) nv_wrvgas(obj, head, index, value); 133c39f472eSBen Skeggs else if (port == 0x03ce) nv_wrvgag(obj, head, index, value); 134c39f472eSBen Skeggs else if (port == 0x03d4) nv_wrvgac(obj, head, index, value); 135c39f472eSBen Skeggs else nv_error(obj, "unknown indexed vga port 0x%04x\n", port); 136c39f472eSBen Skeggs } 137c39f472eSBen Skeggs 138c39f472eSBen Skeggs bool 139c39f472eSBen Skeggs nv_lockvgac(void *obj, bool lock) 140c39f472eSBen Skeggs { 141c39f472eSBen Skeggs struct nouveau_device *dev = nv_device(obj); 142c39f472eSBen Skeggs 143c39f472eSBen Skeggs bool locked = !nv_rdvgac(obj, 0, 0x1f); 144c39f472eSBen Skeggs u8 data = lock ? 0x99 : 0x57; 145c39f472eSBen Skeggs if (dev->card_type < NV_50) 146c39f472eSBen Skeggs nv_wrvgac(obj, 0, 0x1f, data); 147c39f472eSBen Skeggs else 148c39f472eSBen Skeggs nv_wrvgac(obj, 0, 0x3f, data); 149c39f472eSBen Skeggs if (dev->chipset == 0x11) { 150c39f472eSBen Skeggs if (!(nv_rd32(obj, 0x001084) & 0x10000000)) 151c39f472eSBen Skeggs nv_wrvgac(obj, 1, 0x1f, data); 152c39f472eSBen Skeggs } 153c39f472eSBen Skeggs return locked; 154c39f472eSBen Skeggs } 155c39f472eSBen Skeggs 156c39f472eSBen Skeggs /* CR44 takes values 0 (head A), 3 (head B) and 4 (heads tied) 157c39f472eSBen Skeggs * it affects only the 8 bit vga io regs, which we access using mmio at 158c39f472eSBen Skeggs * 0xc{0,2}3c*, 0x60{1,3}3*, and 0x68{1,3}3d* 159c39f472eSBen Skeggs * in general, the set value of cr44 does not matter: reg access works as 160c39f472eSBen Skeggs * expected and values can be set for the appropriate head by using a 0x2000 161c39f472eSBen Skeggs * offset as required 162c39f472eSBen Skeggs * however: 163c39f472eSBen Skeggs * a) pre nv40, the head B range of PRMVIO regs at 0xc23c* was not exposed and 164c39f472eSBen Skeggs * cr44 must be set to 0 or 3 for accessing values on the correct head 165c39f472eSBen Skeggs * through the common 0xc03c* addresses 166c39f472eSBen Skeggs * b) in tied mode (4) head B is programmed to the values set on head A, and 167c39f472eSBen Skeggs * access using the head B addresses can have strange results, ergo we leave 168c39f472eSBen Skeggs * tied mode in init once we know to what cr44 should be restored on exit 169c39f472eSBen Skeggs * 170c39f472eSBen Skeggs * the owner parameter is slightly abused: 171c39f472eSBen Skeggs * 0 and 1 are treated as head values and so the set value is (owner * 3) 172c39f472eSBen Skeggs * other values are treated as literal values to set 173c39f472eSBen Skeggs */ 174c39f472eSBen Skeggs u8 175c39f472eSBen Skeggs nv_rdvgaowner(void *obj) 176c39f472eSBen Skeggs { 177c39f472eSBen Skeggs if (nv_device(obj)->card_type < NV_50) { 178c39f472eSBen Skeggs if (nv_device(obj)->chipset == 0x11) { 179c39f472eSBen Skeggs u32 tied = nv_rd32(obj, 0x001084) & 0x10000000; 180c39f472eSBen Skeggs if (tied == 0) { 181c39f472eSBen Skeggs u8 slA = nv_rdvgac(obj, 0, 0x28) & 0x80; 182c39f472eSBen Skeggs u8 tvA = nv_rdvgac(obj, 0, 0x33) & 0x01; 183c39f472eSBen Skeggs u8 slB = nv_rdvgac(obj, 1, 0x28) & 0x80; 184c39f472eSBen Skeggs u8 tvB = nv_rdvgac(obj, 1, 0x33) & 0x01; 185c39f472eSBen Skeggs if (slA && !tvA) return 0x00; 186c39f472eSBen Skeggs if (slB && !tvB) return 0x03; 187c39f472eSBen Skeggs if (slA) return 0x00; 188c39f472eSBen Skeggs if (slB) return 0x03; 189c39f472eSBen Skeggs return 0x00; 190c39f472eSBen Skeggs } 191c39f472eSBen Skeggs return 0x04; 192c39f472eSBen Skeggs } 193c39f472eSBen Skeggs 194c39f472eSBen Skeggs return nv_rdvgac(obj, 0, 0x44); 195c39f472eSBen Skeggs } 196c39f472eSBen Skeggs 197c39f472eSBen Skeggs nv_error(obj, "rdvgaowner after nv4x\n"); 198c39f472eSBen Skeggs return 0x00; 199c39f472eSBen Skeggs } 200c39f472eSBen Skeggs 201c39f472eSBen Skeggs void 202c39f472eSBen Skeggs nv_wrvgaowner(void *obj, u8 select) 203c39f472eSBen Skeggs { 204c39f472eSBen Skeggs if (nv_device(obj)->card_type < NV_50) { 205c39f472eSBen Skeggs u8 owner = (select == 1) ? 3 : select; 206c39f472eSBen Skeggs if (nv_device(obj)->chipset == 0x11) { 207c39f472eSBen Skeggs /* workaround hw lockup bug */ 208c39f472eSBen Skeggs nv_rdvgac(obj, 0, 0x1f); 209c39f472eSBen Skeggs nv_rdvgac(obj, 1, 0x1f); 210c39f472eSBen Skeggs } 211c39f472eSBen Skeggs 212c39f472eSBen Skeggs nv_wrvgac(obj, 0, 0x44, owner); 213c39f472eSBen Skeggs 214c39f472eSBen Skeggs if (nv_device(obj)->chipset == 0x11) { 215c39f472eSBen Skeggs nv_wrvgac(obj, 0, 0x2e, owner); 216c39f472eSBen Skeggs nv_wrvgac(obj, 0, 0x2e, owner); 217c39f472eSBen Skeggs } 218c39f472eSBen Skeggs } else 219c39f472eSBen Skeggs nv_error(obj, "wrvgaowner after nv4x\n"); 220c39f472eSBen Skeggs } 221