1/*- 2 * Copyright (c) 2000 Doug Rabson 3 * All rights reserved. 4 * 5 * Redistribution and use in source and binary forms, with or without 6 * modification, are permitted provided that the following conditions 7 * are met: 8 * 1. Redistributions of source code must retain the above copyright 9 * notice, this list of conditions and the following disclaimer. 10 * 2. Redistributions in binary form must reproduce the above copyright 11 * notice, this list of conditions and the following disclaimer in the 12 * documentation and/or other materials provided with the distribution. 13 * 14 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 15 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 16 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 17 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 18 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 19 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 20 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 21 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 22 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 23 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 24 * SUCH DAMAGE. 25 */ 26 27#include <sys/cdefs.h>
| 1/*- 2 * Copyright (c) 2000 Doug Rabson 3 * All rights reserved. 4 * 5 * Redistribution and use in source and binary forms, with or without 6 * modification, are permitted provided that the following conditions 7 * are met: 8 * 1. Redistributions of source code must retain the above copyright 9 * notice, this list of conditions and the following disclaimer. 10 * 2. Redistributions in binary form must reproduce the above copyright 11 * notice, this list of conditions and the following disclaimer in the 12 * documentation and/or other materials provided with the distribution. 13 * 14 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 15 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 16 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 17 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 18 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 19 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 20 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 21 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 22 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 23 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 24 * SUCH DAMAGE. 25 */ 26 27#include <sys/cdefs.h>
|
39#include <sys/mutex.h> 40#include <sys/proc.h> 41 42#include <dev/pci/pcivar.h> 43#include <dev/pci/pcireg.h> 44#include <pci/agppriv.h> 45#include <pci/agpreg.h> 46 47#include <vm/vm.h> 48#include <vm/vm_object.h> 49#include <vm/pmap.h> 50 51struct agp_sis_softc { 52 struct agp_softc agp; 53 u_int32_t initial_aperture; /* aperture size at startup */ 54 struct agp_gatt *gatt; 55}; 56 57static const char* 58agp_sis_match(device_t dev) 59{ 60 if (pci_get_class(dev) != PCIC_BRIDGE 61 || pci_get_subclass(dev) != PCIS_BRIDGE_HOST) 62 return NULL; 63 64 if (agp_find_caps(dev) == 0) 65 return NULL; 66 67 switch (pci_get_devid(dev)) { 68 case 0x00011039: 69 return ("SiS 5591 host to AGP bridge"); 70 case 0x05301039: 71 return ("SiS 530 host to AGP bridge"); 72 case 0x05401039: 73 return ("SiS 540 host to AGP bridge"); 74 case 0x05501039: 75 return ("SiS 550 host to AGP bridge"); 76 case 0x06201039: 77 return ("SiS 620 host to AGP bridge"); 78 case 0x06301039: 79 return ("SiS 630 host to AGP bridge"); 80 case 0x06451039: 81 return ("SiS 645 host to AGP bridge"); 82 case 0x06461039: 83 return ("SiS 645DX host to AGP bridge"); 84 case 0x06481039: 85 return ("SiS 648 host to AGP bridge"); 86 case 0x06501039: 87 return ("SiS 650 host to AGP bridge"); 88 case 0x06511039: 89 return ("SiS 651 host to AGP bridge"); 90 case 0x06551039: 91 return ("SiS 655 host to AGP bridge"); 92 case 0x06611039: 93 return ("SiS 661 host to AGP bridge"); 94 case 0x07301039: 95 return ("SiS 730 host to AGP bridge"); 96 case 0x07351039: 97 return ("SiS 735 host to AGP bridge"); 98 case 0x07401039: 99 return ("SiS 740 host to AGP bridge"); 100 case 0x07411039: 101 return ("SiS 741 host to AGP bridge"); 102 case 0x07451039: 103 return ("SiS 745 host to AGP bridge"); 104 case 0x07461039: 105 return ("SiS 746 host to AGP bridge"); 106 case 0x07601039: 107 return ("SiS 760 host to AGP bridge"); 108 }; 109 110 if (pci_get_vendor(dev) == 0x1039) 111 return ("SIS Generic host to PCI bridge"); 112 113 return NULL; 114} 115 116static int 117agp_sis_probe(device_t dev) 118{ 119 const char *desc; 120 121 if (resource_disabled("agp", device_get_unit(dev))) 122 return (ENXIO); 123 desc = agp_sis_match(dev); 124 if (desc) { 125 device_verbose(dev); 126 device_set_desc(dev, desc); 127 return 0; 128 } 129 130 return ENXIO; 131} 132 133static int 134agp_sis_attach(device_t dev) 135{ 136 struct agp_sis_softc *sc = device_get_softc(dev); 137 struct agp_gatt *gatt; 138 int error; 139 140 error = agp_generic_attach(dev); 141 if (error) 142 return error; 143 144 sc->initial_aperture = AGP_GET_APERTURE(dev); 145 146 for (;;) { 147 gatt = agp_alloc_gatt(dev); 148 if (gatt) 149 break; 150 151 /* 152 * Probably contigmalloc failure. Try reducing the 153 * aperture so that the gatt size reduces. 154 */ 155 if (AGP_SET_APERTURE(dev, AGP_GET_APERTURE(dev) / 2)) { 156 agp_generic_detach(dev); 157 return ENOMEM; 158 } 159 } 160 sc->gatt = gatt; 161 162 /* Install the gatt. */ 163 pci_write_config(dev, AGP_SIS_ATTBASE, gatt->ag_physical, 4); 164 165 /* Enable the aperture. */ 166 pci_write_config(dev, AGP_SIS_WINCTRL, 167 pci_read_config(dev, AGP_SIS_WINCTRL, 1) | 3, 1); 168 169 /* 170 * Enable the TLB and make it automatically invalidate entries 171 * when the GATT is written. 172 */ 173 pci_write_config(dev, AGP_SIS_TLBCTRL, 0x05, 1); 174 175 return 0; 176} 177 178static int 179agp_sis_detach(device_t dev) 180{ 181 struct agp_sis_softc *sc = device_get_softc(dev); 182 int error; 183 184 error = agp_generic_detach(dev); 185 if (error) 186 return error; 187 188 /* Disable the aperture.. */ 189 pci_write_config(dev, AGP_SIS_WINCTRL, 190 pci_read_config(dev, AGP_SIS_WINCTRL, 1) & ~3, 1); 191 192 /* and the TLB. */ 193 pci_write_config(dev, AGP_SIS_TLBCTRL, 0, 1); 194 195 /* Put the aperture back the way it started. */ 196 AGP_SET_APERTURE(dev, sc->initial_aperture); 197 198 agp_free_gatt(sc->gatt); 199 return 0; 200} 201 202static u_int32_t 203agp_sis_get_aperture(device_t dev) 204{ 205 int gws; 206 207 /* 208 * The aperture size is equal to 4M<<gws. 209 */ 210 gws = (pci_read_config(dev, AGP_SIS_WINCTRL, 1) & 0x70) >> 4; 211 return (4*1024*1024) << gws; 212} 213 214static int 215agp_sis_set_aperture(device_t dev, u_int32_t aperture) 216{ 217 int gws; 218 219 /* 220 * Check for a power of two and make sure its within the 221 * programmable range. 222 */ 223 if (aperture & (aperture - 1) 224 || aperture < 4*1024*1024 225 || aperture > 256*1024*1024) 226 return EINVAL; 227 228 gws = ffs(aperture / 4*1024*1024) - 1; 229 230 pci_write_config(dev, AGP_SIS_WINCTRL, 231 ((pci_read_config(dev, AGP_SIS_WINCTRL, 1) & ~0x70) 232 | gws << 4), 1); 233 234 return 0; 235} 236 237static int 238agp_sis_bind_page(device_t dev, int offset, vm_offset_t physical) 239{ 240 struct agp_sis_softc *sc = device_get_softc(dev); 241 242 if (offset < 0 || offset >= (sc->gatt->ag_entries << AGP_PAGE_SHIFT)) 243 return EINVAL; 244 245 sc->gatt->ag_virtual[offset >> AGP_PAGE_SHIFT] = physical; 246 return 0; 247} 248 249static int 250agp_sis_unbind_page(device_t dev, int offset) 251{ 252 struct agp_sis_softc *sc = device_get_softc(dev); 253 254 if (offset < 0 || offset >= (sc->gatt->ag_entries << AGP_PAGE_SHIFT)) 255 return EINVAL; 256 257 sc->gatt->ag_virtual[offset >> AGP_PAGE_SHIFT] = 0; 258 return 0; 259} 260 261static void 262agp_sis_flush_tlb(device_t dev) 263{ 264 pci_write_config(dev, AGP_SIS_TLBFLUSH, 0x02, 1); 265} 266 267static device_method_t agp_sis_methods[] = { 268 /* Device interface */ 269 DEVMETHOD(device_probe, agp_sis_probe), 270 DEVMETHOD(device_attach, agp_sis_attach), 271 DEVMETHOD(device_detach, agp_sis_detach), 272 DEVMETHOD(device_shutdown, bus_generic_shutdown), 273 DEVMETHOD(device_suspend, bus_generic_suspend), 274 DEVMETHOD(device_resume, bus_generic_resume), 275 276 /* AGP interface */ 277 DEVMETHOD(agp_get_aperture, agp_sis_get_aperture), 278 DEVMETHOD(agp_set_aperture, agp_sis_set_aperture), 279 DEVMETHOD(agp_bind_page, agp_sis_bind_page), 280 DEVMETHOD(agp_unbind_page, agp_sis_unbind_page), 281 DEVMETHOD(agp_flush_tlb, agp_sis_flush_tlb), 282 DEVMETHOD(agp_enable, agp_generic_enable), 283 DEVMETHOD(agp_alloc_memory, agp_generic_alloc_memory), 284 DEVMETHOD(agp_free_memory, agp_generic_free_memory), 285 DEVMETHOD(agp_bind_memory, agp_generic_bind_memory), 286 DEVMETHOD(agp_unbind_memory, agp_generic_unbind_memory), 287 288 { 0, 0 } 289}; 290 291static driver_t agp_sis_driver = { 292 "agp", 293 agp_sis_methods, 294 sizeof(struct agp_sis_softc), 295}; 296 297static devclass_t agp_devclass; 298 299DRIVER_MODULE(agp_sis, pci, agp_sis_driver, agp_devclass, 0, 0); 300MODULE_DEPEND(agp_sis, agp, 1, 1, 1); 301MODULE_DEPEND(agp_sis, pci, 1, 1, 1);
| 38#include <sys/mutex.h> 39#include <sys/proc.h> 40 41#include <dev/pci/pcivar.h> 42#include <dev/pci/pcireg.h> 43#include <pci/agppriv.h> 44#include <pci/agpreg.h> 45 46#include <vm/vm.h> 47#include <vm/vm_object.h> 48#include <vm/pmap.h> 49 50struct agp_sis_softc { 51 struct agp_softc agp; 52 u_int32_t initial_aperture; /* aperture size at startup */ 53 struct agp_gatt *gatt; 54}; 55 56static const char* 57agp_sis_match(device_t dev) 58{ 59 if (pci_get_class(dev) != PCIC_BRIDGE 60 || pci_get_subclass(dev) != PCIS_BRIDGE_HOST) 61 return NULL; 62 63 if (agp_find_caps(dev) == 0) 64 return NULL; 65 66 switch (pci_get_devid(dev)) { 67 case 0x00011039: 68 return ("SiS 5591 host to AGP bridge"); 69 case 0x05301039: 70 return ("SiS 530 host to AGP bridge"); 71 case 0x05401039: 72 return ("SiS 540 host to AGP bridge"); 73 case 0x05501039: 74 return ("SiS 550 host to AGP bridge"); 75 case 0x06201039: 76 return ("SiS 620 host to AGP bridge"); 77 case 0x06301039: 78 return ("SiS 630 host to AGP bridge"); 79 case 0x06451039: 80 return ("SiS 645 host to AGP bridge"); 81 case 0x06461039: 82 return ("SiS 645DX host to AGP bridge"); 83 case 0x06481039: 84 return ("SiS 648 host to AGP bridge"); 85 case 0x06501039: 86 return ("SiS 650 host to AGP bridge"); 87 case 0x06511039: 88 return ("SiS 651 host to AGP bridge"); 89 case 0x06551039: 90 return ("SiS 655 host to AGP bridge"); 91 case 0x06611039: 92 return ("SiS 661 host to AGP bridge"); 93 case 0x07301039: 94 return ("SiS 730 host to AGP bridge"); 95 case 0x07351039: 96 return ("SiS 735 host to AGP bridge"); 97 case 0x07401039: 98 return ("SiS 740 host to AGP bridge"); 99 case 0x07411039: 100 return ("SiS 741 host to AGP bridge"); 101 case 0x07451039: 102 return ("SiS 745 host to AGP bridge"); 103 case 0x07461039: 104 return ("SiS 746 host to AGP bridge"); 105 case 0x07601039: 106 return ("SiS 760 host to AGP bridge"); 107 }; 108 109 if (pci_get_vendor(dev) == 0x1039) 110 return ("SIS Generic host to PCI bridge"); 111 112 return NULL; 113} 114 115static int 116agp_sis_probe(device_t dev) 117{ 118 const char *desc; 119 120 if (resource_disabled("agp", device_get_unit(dev))) 121 return (ENXIO); 122 desc = agp_sis_match(dev); 123 if (desc) { 124 device_verbose(dev); 125 device_set_desc(dev, desc); 126 return 0; 127 } 128 129 return ENXIO; 130} 131 132static int 133agp_sis_attach(device_t dev) 134{ 135 struct agp_sis_softc *sc = device_get_softc(dev); 136 struct agp_gatt *gatt; 137 int error; 138 139 error = agp_generic_attach(dev); 140 if (error) 141 return error; 142 143 sc->initial_aperture = AGP_GET_APERTURE(dev); 144 145 for (;;) { 146 gatt = agp_alloc_gatt(dev); 147 if (gatt) 148 break; 149 150 /* 151 * Probably contigmalloc failure. Try reducing the 152 * aperture so that the gatt size reduces. 153 */ 154 if (AGP_SET_APERTURE(dev, AGP_GET_APERTURE(dev) / 2)) { 155 agp_generic_detach(dev); 156 return ENOMEM; 157 } 158 } 159 sc->gatt = gatt; 160 161 /* Install the gatt. */ 162 pci_write_config(dev, AGP_SIS_ATTBASE, gatt->ag_physical, 4); 163 164 /* Enable the aperture. */ 165 pci_write_config(dev, AGP_SIS_WINCTRL, 166 pci_read_config(dev, AGP_SIS_WINCTRL, 1) | 3, 1); 167 168 /* 169 * Enable the TLB and make it automatically invalidate entries 170 * when the GATT is written. 171 */ 172 pci_write_config(dev, AGP_SIS_TLBCTRL, 0x05, 1); 173 174 return 0; 175} 176 177static int 178agp_sis_detach(device_t dev) 179{ 180 struct agp_sis_softc *sc = device_get_softc(dev); 181 int error; 182 183 error = agp_generic_detach(dev); 184 if (error) 185 return error; 186 187 /* Disable the aperture.. */ 188 pci_write_config(dev, AGP_SIS_WINCTRL, 189 pci_read_config(dev, AGP_SIS_WINCTRL, 1) & ~3, 1); 190 191 /* and the TLB. */ 192 pci_write_config(dev, AGP_SIS_TLBCTRL, 0, 1); 193 194 /* Put the aperture back the way it started. */ 195 AGP_SET_APERTURE(dev, sc->initial_aperture); 196 197 agp_free_gatt(sc->gatt); 198 return 0; 199} 200 201static u_int32_t 202agp_sis_get_aperture(device_t dev) 203{ 204 int gws; 205 206 /* 207 * The aperture size is equal to 4M<<gws. 208 */ 209 gws = (pci_read_config(dev, AGP_SIS_WINCTRL, 1) & 0x70) >> 4; 210 return (4*1024*1024) << gws; 211} 212 213static int 214agp_sis_set_aperture(device_t dev, u_int32_t aperture) 215{ 216 int gws; 217 218 /* 219 * Check for a power of two and make sure its within the 220 * programmable range. 221 */ 222 if (aperture & (aperture - 1) 223 || aperture < 4*1024*1024 224 || aperture > 256*1024*1024) 225 return EINVAL; 226 227 gws = ffs(aperture / 4*1024*1024) - 1; 228 229 pci_write_config(dev, AGP_SIS_WINCTRL, 230 ((pci_read_config(dev, AGP_SIS_WINCTRL, 1) & ~0x70) 231 | gws << 4), 1); 232 233 return 0; 234} 235 236static int 237agp_sis_bind_page(device_t dev, int offset, vm_offset_t physical) 238{ 239 struct agp_sis_softc *sc = device_get_softc(dev); 240 241 if (offset < 0 || offset >= (sc->gatt->ag_entries << AGP_PAGE_SHIFT)) 242 return EINVAL; 243 244 sc->gatt->ag_virtual[offset >> AGP_PAGE_SHIFT] = physical; 245 return 0; 246} 247 248static int 249agp_sis_unbind_page(device_t dev, int offset) 250{ 251 struct agp_sis_softc *sc = device_get_softc(dev); 252 253 if (offset < 0 || offset >= (sc->gatt->ag_entries << AGP_PAGE_SHIFT)) 254 return EINVAL; 255 256 sc->gatt->ag_virtual[offset >> AGP_PAGE_SHIFT] = 0; 257 return 0; 258} 259 260static void 261agp_sis_flush_tlb(device_t dev) 262{ 263 pci_write_config(dev, AGP_SIS_TLBFLUSH, 0x02, 1); 264} 265 266static device_method_t agp_sis_methods[] = { 267 /* Device interface */ 268 DEVMETHOD(device_probe, agp_sis_probe), 269 DEVMETHOD(device_attach, agp_sis_attach), 270 DEVMETHOD(device_detach, agp_sis_detach), 271 DEVMETHOD(device_shutdown, bus_generic_shutdown), 272 DEVMETHOD(device_suspend, bus_generic_suspend), 273 DEVMETHOD(device_resume, bus_generic_resume), 274 275 /* AGP interface */ 276 DEVMETHOD(agp_get_aperture, agp_sis_get_aperture), 277 DEVMETHOD(agp_set_aperture, agp_sis_set_aperture), 278 DEVMETHOD(agp_bind_page, agp_sis_bind_page), 279 DEVMETHOD(agp_unbind_page, agp_sis_unbind_page), 280 DEVMETHOD(agp_flush_tlb, agp_sis_flush_tlb), 281 DEVMETHOD(agp_enable, agp_generic_enable), 282 DEVMETHOD(agp_alloc_memory, agp_generic_alloc_memory), 283 DEVMETHOD(agp_free_memory, agp_generic_free_memory), 284 DEVMETHOD(agp_bind_memory, agp_generic_bind_memory), 285 DEVMETHOD(agp_unbind_memory, agp_generic_unbind_memory), 286 287 { 0, 0 } 288}; 289 290static driver_t agp_sis_driver = { 291 "agp", 292 agp_sis_methods, 293 sizeof(struct agp_sis_softc), 294}; 295 296static devclass_t agp_devclass; 297 298DRIVER_MODULE(agp_sis, pci, agp_sis_driver, agp_devclass, 0, 0); 299MODULE_DEPEND(agp_sis, agp, 1, 1, 1); 300MODULE_DEPEND(agp_sis, pci, 1, 1, 1);
|