Home | History | Annotate | Line # | Download | only in via
via_pci.c revision 1.2.22.1
      1  1.2.22.1  christos /*	$NetBSD: via_pci.c,v 1.2.22.1 2019/06/10 22:08:33 christos Exp $	*/
      2       1.1  riastrad 
      3       1.1  riastrad /*-
      4       1.1  riastrad  * Copyright (c) 2015 The NetBSD Foundation, Inc.
      5       1.1  riastrad  * All rights reserved.
      6       1.1  riastrad  *
      7       1.1  riastrad  * This code is derived from software contributed to The NetBSD Foundation
      8       1.1  riastrad  * by Taylor R. Campbell.
      9       1.1  riastrad  *
     10       1.1  riastrad  * Redistribution and use in source and binary forms, with or without
     11       1.1  riastrad  * modification, are permitted provided that the following conditions
     12       1.1  riastrad  * are met:
     13       1.1  riastrad  * 1. Redistributions of source code must retain the above copyright
     14       1.1  riastrad  *    notice, this list of conditions and the following disclaimer.
     15       1.1  riastrad  * 2. Redistributions in binary form must reproduce the above copyright
     16       1.1  riastrad  *    notice, this list of conditions and the following disclaimer in the
     17       1.1  riastrad  *    documentation and/or other materials provided with the distribution.
     18       1.1  riastrad  *
     19       1.1  riastrad  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     20       1.1  riastrad  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     21       1.1  riastrad  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     22       1.1  riastrad  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     23       1.1  riastrad  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     24       1.1  riastrad  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     25       1.1  riastrad  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     26       1.1  riastrad  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     27       1.1  riastrad  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     28       1.1  riastrad  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     29       1.1  riastrad  * POSSIBILITY OF SUCH DAMAGE.
     30       1.1  riastrad  */
     31       1.1  riastrad 
     32       1.1  riastrad #include <sys/cdefs.h>
     33  1.2.22.1  christos __KERNEL_RCSID(0, "$NetBSD: via_pci.c,v 1.2.22.1 2019/06/10 22:08:33 christos Exp $");
     34       1.1  riastrad 
     35       1.1  riastrad #include <sys/types.h>
     36       1.1  riastrad #include <sys/device.h>
     37       1.2  riastrad #include <sys/pmf.h>
     38       1.1  riastrad #include <sys/systm.h>
     39       1.1  riastrad 
     40       1.1  riastrad #include <linux/pci.h>
     41       1.1  riastrad 
     42       1.1  riastrad #include <drm/drmP.h>
     43       1.1  riastrad #include <drm/drm_pciids.h>
     44       1.1  riastrad #include <drm/via_drm.h>
     45       1.1  riastrad 
     46       1.1  riastrad #include "via_drv.h"
     47       1.1  riastrad 
     48       1.1  riastrad struct viadrm_softc {
     49       1.1  riastrad 	device_t		sc_dev;
     50       1.1  riastrad 	struct pci_dev		sc_pci_dev;
     51       1.1  riastrad 	struct drm_device	*sc_drm_dev;
     52       1.1  riastrad };
     53       1.1  riastrad 
     54       1.1  riastrad static int	viadrm_match(device_t, cfdata_t, void *);
     55       1.1  riastrad static void	viadrm_attach(device_t, device_t, void *);
     56       1.1  riastrad static int	viadrm_detach(device_t, int);
     57       1.1  riastrad 
     58       1.1  riastrad extern struct drm_driver *const via_drm_driver; /* XXX */
     59       1.1  riastrad 
     60       1.1  riastrad CFATTACH_DECL_NEW(viadrmums, sizeof(struct viadrm_softc),
     61       1.1  riastrad     viadrm_match, viadrm_attach, viadrm_detach, NULL);
     62       1.1  riastrad 
     63       1.1  riastrad static const struct pci_device_id viadrm_pci_ids[] = {
     64       1.1  riastrad 	viadrv_PCI_IDS
     65       1.1  riastrad };
     66       1.1  riastrad 
     67       1.1  riastrad static const unsigned long *
     68       1.1  riastrad viadrm_lookup(const struct pci_attach_args *pa)
     69       1.1  riastrad {
     70       1.1  riastrad 	unsigned i;
     71       1.1  riastrad 
     72       1.1  riastrad 	for (i = 0; i < __arraycount(viadrm_pci_ids); i++) {
     73       1.1  riastrad 		KASSERT(viadrm_pci_ids[i].subvendor == PCI_ANY_ID);
     74       1.1  riastrad 		KASSERT(viadrm_pci_ids[i].subdevice == PCI_ANY_ID);
     75       1.1  riastrad 		KASSERT(viadrm_pci_ids[i].class == 0);
     76       1.1  riastrad 		KASSERT(viadrm_pci_ids[i].class_mask == 0);
     77       1.1  riastrad 		if (PCI_VENDOR(pa->pa_id) != viadrm_pci_ids[i].vendor)
     78       1.1  riastrad 			continue;
     79       1.1  riastrad 		if (PCI_PRODUCT(pa->pa_id) != viadrm_pci_ids[i].device)
     80       1.1  riastrad 			continue;
     81       1.1  riastrad 		return &viadrm_pci_ids[i].driver_data;
     82       1.1  riastrad 	}
     83       1.1  riastrad 
     84       1.1  riastrad 	return NULL;
     85       1.1  riastrad }
     86       1.1  riastrad 
     87       1.1  riastrad static int
     88       1.1  riastrad viadrm_match(device_t parent, cfdata_t match, void *aux)
     89       1.1  riastrad {
     90       1.1  riastrad 	extern int viadrm_guarantee_initialized(void);
     91       1.1  riastrad 	const struct pci_attach_args *const pa = aux;
     92       1.1  riastrad 	int error;
     93       1.1  riastrad 
     94       1.1  riastrad 	error = viadrm_guarantee_initialized();
     95       1.1  riastrad 	if (error) {
     96       1.1  riastrad 		aprint_error("viadrm: failed to initialize: %d\n", error);
     97       1.1  riastrad 		return 0;
     98       1.1  riastrad 	}
     99       1.1  riastrad 
    100       1.1  riastrad 	if (viadrm_lookup(pa) == NULL)
    101       1.1  riastrad 		return 0;
    102       1.1  riastrad 
    103       1.1  riastrad 	return 1;
    104       1.1  riastrad }
    105       1.1  riastrad 
    106       1.1  riastrad static void
    107       1.1  riastrad viadrm_attach(device_t parent, device_t self, void *aux)
    108       1.1  riastrad {
    109       1.1  riastrad 	struct viadrm_softc *const sc = device_private(self);
    110       1.1  riastrad 	const struct pci_attach_args *const pa = aux;
    111       1.1  riastrad 	const unsigned long *const cookiep = viadrm_lookup(pa);
    112       1.1  riastrad 	int error;
    113       1.1  riastrad 
    114       1.1  riastrad 	KASSERT(cookiep != NULL);
    115       1.1  riastrad 
    116       1.2  riastrad 	if (!pmf_device_register(self, NULL, NULL))
    117       1.2  riastrad 		aprint_error_dev(self, "couldn't establish power handler\n");
    118       1.2  riastrad 
    119  1.2.22.1  christos 	/* Initialize the Linux PCI device descriptor.  */
    120  1.2.22.1  christos 	linux_pci_dev_init(&sc->sc_pci_dev, self, device_parent(self), pa, 0);
    121  1.2.22.1  christos 
    122       1.1  riastrad 	/* XXX errno Linux->NetBSD */
    123       1.1  riastrad 	error = -drm_pci_attach(self, pa, &sc->sc_pci_dev, via_drm_driver,
    124       1.1  riastrad 	    *cookiep, &sc->sc_drm_dev);
    125       1.1  riastrad 	if (error) {
    126       1.1  riastrad 		aprint_error_dev(self, "unable to attach drm: %d\n", error);
    127       1.1  riastrad 		return;
    128       1.1  riastrad 	}
    129       1.1  riastrad }
    130       1.1  riastrad 
    131       1.1  riastrad static int
    132       1.1  riastrad viadrm_detach(device_t self, int flags)
    133       1.1  riastrad {
    134       1.1  riastrad 	struct viadrm_softc *const sc = device_private(self);
    135       1.1  riastrad 	int error;
    136       1.1  riastrad 
    137       1.1  riastrad 	error = config_detach_children(self, flags);
    138       1.1  riastrad 	if (error)
    139       1.1  riastrad 		return error;
    140       1.1  riastrad 	if (sc->sc_drm_dev == NULL)
    141       1.1  riastrad 		goto out;
    142       1.1  riastrad 	/* XXX errno Linux->NetBSD */
    143       1.1  riastrad 	error = -drm_pci_detach(sc->sc_drm_dev, flags);
    144       1.1  riastrad 	if (error)
    145       1.1  riastrad 		return error;
    146       1.1  riastrad 	sc->sc_drm_dev = NULL;
    147  1.2.22.1  christos 
    148  1.2.22.1  christos out:	linux_pci_dev_destroy(&sc->sc_pci_dev);
    149       1.2  riastrad 	pmf_device_deregister(self);
    150  1.2.22.1  christos 	return 0;
    151       1.1  riastrad }
    152