453 lines
10 KiB
C
453 lines
10 KiB
C
|
/*
|
||
|
* PLX pseudo controller
|
||
|
*-------------------------------------------------------------------------
|
||
|
*
|
||
|
* Copyright (c) 2001 M. Warner Losh. All rights reserved.
|
||
|
*
|
||
|
* Redistribution and use in source and binary forms, with or without
|
||
|
* modification, are permitted provided that the following conditions
|
||
|
* are met:
|
||
|
* 1. Redistributions of source code must retain the above copyright
|
||
|
* notice, this list of conditions and the following disclaimer.
|
||
|
* 2. Redistributions in binary form must reproduce the above copyright
|
||
|
* notice, this list of conditions and the following disclaimer in the
|
||
|
* documentation and/or other materials provided with the distribution.
|
||
|
*
|
||
|
* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
|
||
|
* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
|
||
|
* OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
|
||
|
* IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
|
||
|
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
|
||
|
* NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
|
||
|
* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
|
||
|
* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
|
||
|
* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
|
||
|
* THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
||
|
*
|
||
|
* $FreeBSD$
|
||
|
*/
|
||
|
|
||
|
#include <sys/param.h>
|
||
|
#include <sys/bus.h>
|
||
|
#include <sys/systm.h>
|
||
|
#include <sys/kernel.h>
|
||
|
#include <sys/module.h>
|
||
|
|
||
|
#include <pccard/meciareg.h>
|
||
|
#include <pccard/cardinfo.h>
|
||
|
#include <pccard/slot.h>
|
||
|
#include <dev/pccard/pccardvar.h>
|
||
|
#include "card_if.h"
|
||
|
|
||
|
#define PLXIC_DEVICE2SOFTC(dev) ((struct plxic_slot *) device_get_softc(dev))
|
||
|
|
||
|
/*
|
||
|
* Prototypes for interrupt handler.
|
||
|
*/
|
||
|
static driver_intr_t plxicintr;
|
||
|
static int plxic_ioctl(struct slot *, int, caddr_t);
|
||
|
static int plxic_power(struct slot *);
|
||
|
static void plxic_mapirq(struct slot *, int);
|
||
|
static timeout_t plxic_reset;
|
||
|
static void plxic_resume(struct slot *);
|
||
|
static void plxic_disable(struct slot *);
|
||
|
static int plxic_memory(struct slot *, int);
|
||
|
static int plxic_io(struct slot *, int);
|
||
|
|
||
|
/*
|
||
|
* Per-slot data table.
|
||
|
*/
|
||
|
struct plxic_slot {
|
||
|
int unit; /* Unit number */
|
||
|
int slotnum; /* My slot number */
|
||
|
struct slot *slt; /* Back ptr to slot */
|
||
|
device_t dev; /* My device */
|
||
|
u_char last_reg1; /* Last value of change reg */
|
||
|
};
|
||
|
|
||
|
static struct slot_ctrl plxic_cinfo = {
|
||
|
plxic_mapirq,
|
||
|
plxic_memory,
|
||
|
plxic_io,
|
||
|
plxic_reset,
|
||
|
plxic_disable,
|
||
|
plxic_power,
|
||
|
plxic_ioctl,
|
||
|
plxic_resume,
|
||
|
1,
|
||
|
#if 0
|
||
|
1
|
||
|
#else
|
||
|
2 /* Fake for UE2212 LAN card */
|
||
|
#endif
|
||
|
};
|
||
|
|
||
|
static int validunits = 0;
|
||
|
|
||
|
/*
|
||
|
* For each available slot, allocate a PC-CARD slot.
|
||
|
*/
|
||
|
static int
|
||
|
plxic_probe(device_t dev)
|
||
|
{
|
||
|
return (ENXIO);
|
||
|
}
|
||
|
|
||
|
static int
|
||
|
plxic_attach(device_t dev)
|
||
|
{
|
||
|
int error;
|
||
|
void *ih;
|
||
|
device_t kid;
|
||
|
struct resource *r;
|
||
|
int rid;
|
||
|
struct slot *slt;
|
||
|
struct plxic_slot *sp;
|
||
|
|
||
|
sp = PLXIC_DEVICE2SOFTC(dev);
|
||
|
sp->unit = validunits++;
|
||
|
kid = device_add_child(dev, NULL, -1);
|
||
|
if (kid == NULL) {
|
||
|
device_printf(dev, "Can't add pccard bus slot 0\n");
|
||
|
return (ENXIO);
|
||
|
}
|
||
|
device_probe_and_attach(kid);
|
||
|
slt = pccard_init_slot(kid, &plxic_cinfo);
|
||
|
if (slt == 0) {
|
||
|
device_printf(dev, "Can't get pccard info slot 0\n");
|
||
|
return (ENXIO);
|
||
|
}
|
||
|
slt->cdata = sp;
|
||
|
sp->slt = slt;
|
||
|
validunits++;
|
||
|
|
||
|
rid = 0;
|
||
|
r = bus_alloc_resource(dev, SYS_RES_IRQ, &rid, 0, ~0, 1, RF_ACTIVE);
|
||
|
if (r) {
|
||
|
error = bus_setup_intr(dev, r, INTR_TYPE_MISC,
|
||
|
plxicintr, (void *) sp, &ih);
|
||
|
if (error) {
|
||
|
bus_release_resource(dev, SYS_RES_IRQ, rid, r);
|
||
|
return (error);
|
||
|
}
|
||
|
sp->slt->irq = rman_get_start(r);
|
||
|
}
|
||
|
|
||
|
return (bus_generic_attach(dev));
|
||
|
}
|
||
|
|
||
|
/*
|
||
|
* ioctl calls - Controller specific ioctls
|
||
|
*/
|
||
|
static int
|
||
|
plxic_ioctl(struct slot *slt, int cmd, caddr_t data)
|
||
|
{
|
||
|
return (ENOTTY);
|
||
|
}
|
||
|
|
||
|
/*
|
||
|
* PLXIC Interrupt handler.
|
||
|
* Check the slot and report any changes.
|
||
|
*/
|
||
|
static void
|
||
|
plxicintr(void *arg)
|
||
|
{
|
||
|
}
|
||
|
|
||
|
static int
|
||
|
plxic_memory(struct slot *slt, int win)
|
||
|
{
|
||
|
struct mem_desc *mp = &slt->mem[win];
|
||
|
|
||
|
if (mp->flags & MDF_ACTIVE) {
|
||
|
} else { /* !(mp->flags & MDF_ACTIVE) */
|
||
|
}
|
||
|
return (0);
|
||
|
}
|
||
|
|
||
|
static int
|
||
|
plxic_io(struct slot *slt, int win)
|
||
|
{
|
||
|
struct io_desc *ip = &slt->io[win];
|
||
|
|
||
|
if (ip->flags & IODF_ACTIVE) {
|
||
|
} else {
|
||
|
}
|
||
|
return (0);
|
||
|
}
|
||
|
|
||
|
static int
|
||
|
plxic_power(struct slot *slt)
|
||
|
{
|
||
|
return (0);
|
||
|
}
|
||
|
|
||
|
static void
|
||
|
plxic_mapirq(struct slot *slt, int irq)
|
||
|
{
|
||
|
}
|
||
|
|
||
|
static void
|
||
|
plxic_reset(void *chan)
|
||
|
{
|
||
|
struct slot *slt = chan;
|
||
|
selwakeup(&slt->selp);
|
||
|
}
|
||
|
|
||
|
static void
|
||
|
plxic_disable(struct slot *slt)
|
||
|
{
|
||
|
/* null function */
|
||
|
}
|
||
|
|
||
|
static void
|
||
|
plxic_resume(struct slot *slt)
|
||
|
{
|
||
|
/* XXX PLXIC How ? */
|
||
|
}
|
||
|
|
||
|
static int
|
||
|
plxic_activate_resource(device_t dev, device_t child, int type, int rid,
|
||
|
struct resource *r)
|
||
|
{
|
||
|
struct pccard_devinfo *devi = device_get_ivars(child);
|
||
|
int err;
|
||
|
|
||
|
if (dev != device_get_parent(device_get_parent(child)) || devi == NULL)
|
||
|
return (bus_generic_activate_resource(dev, child, type,
|
||
|
rid, r));
|
||
|
|
||
|
switch (type) {
|
||
|
case SYS_RES_IOPORT: {
|
||
|
struct io_desc *ip;
|
||
|
ip = &devi->slt->io[rid];
|
||
|
if (ip->flags == 0) {
|
||
|
if (rid == 0)
|
||
|
ip->flags = IODF_WS | IODF_16BIT | IODF_CS16;
|
||
|
else
|
||
|
ip->flags = devi->slt->io[0].flags;
|
||
|
}
|
||
|
ip->flags |= IODF_ACTIVE;
|
||
|
ip->start = rman_get_start(r);
|
||
|
ip->size = rman_get_end(r) - rman_get_start(r) + 1;
|
||
|
err = plxic_cinfo.mapio(devi->slt, rid);
|
||
|
if (err)
|
||
|
return (err);
|
||
|
break;
|
||
|
}
|
||
|
case SYS_RES_IRQ:
|
||
|
/*
|
||
|
* We actually defer the activation of the IRQ resource
|
||
|
* until the interrupt is registered to avoid stray
|
||
|
* interrupt messages.
|
||
|
*/
|
||
|
break;
|
||
|
case SYS_RES_MEMORY: {
|
||
|
struct mem_desc *mp;
|
||
|
if (rid >= NUM_MEM_WINDOWS)
|
||
|
return (EINVAL);
|
||
|
mp = &devi->slt->mem[rid];
|
||
|
mp->flags |= MDF_ACTIVE;
|
||
|
mp->start = (caddr_t) rman_get_start(r);
|
||
|
mp->size = rman_get_end(r) - rman_get_start(r) + 1;
|
||
|
err = plxic_cinfo.mapmem(devi->slt, rid);
|
||
|
if (err)
|
||
|
return (err);
|
||
|
break;
|
||
|
}
|
||
|
default:
|
||
|
break;
|
||
|
}
|
||
|
err = bus_generic_activate_resource(dev, child, type, rid, r);
|
||
|
return (err);
|
||
|
}
|
||
|
|
||
|
static int
|
||
|
plxic_deactivate_resource(device_t dev, device_t child, int type, int rid,
|
||
|
struct resource *r)
|
||
|
{
|
||
|
struct pccard_devinfo *devi = device_get_ivars(child);
|
||
|
int err;
|
||
|
|
||
|
if (dev != device_get_parent(device_get_parent(child)) || devi == NULL)
|
||
|
return (bus_generic_deactivate_resource(dev, child, type,
|
||
|
rid, r));
|
||
|
|
||
|
switch (type) {
|
||
|
case SYS_RES_IOPORT: {
|
||
|
struct io_desc *ip = &devi->slt->io[rid];
|
||
|
ip->flags &= ~IODF_ACTIVE;
|
||
|
err = plxic_cinfo.mapio(devi->slt, rid);
|
||
|
if (err)
|
||
|
return (err);
|
||
|
break;
|
||
|
}
|
||
|
case SYS_RES_IRQ:
|
||
|
break;
|
||
|
case SYS_RES_MEMORY: {
|
||
|
struct mem_desc *mp = &devi->slt->mem[rid];
|
||
|
mp->flags &= ~(MDF_ACTIVE | MDF_ATTR);
|
||
|
err = plxic_cinfo.mapmem(devi->slt, rid);
|
||
|
if (err)
|
||
|
return (err);
|
||
|
break;
|
||
|
}
|
||
|
default:
|
||
|
break;
|
||
|
}
|
||
|
err = bus_generic_deactivate_resource(dev, child, type, rid, r);
|
||
|
return (err);
|
||
|
}
|
||
|
|
||
|
static int
|
||
|
plxic_setup_intr(device_t dev, device_t child, struct resource *irq,
|
||
|
int flags, driver_intr_t *intr, void *arg, void **cookiep)
|
||
|
{
|
||
|
struct pccard_devinfo *devi = device_get_ivars(child);
|
||
|
int err;
|
||
|
|
||
|
err = bus_generic_setup_intr(dev, child, irq, flags, intr, arg,
|
||
|
cookiep);
|
||
|
if (err == 0)
|
||
|
plxic_cinfo.mapirq(devi->slt, rman_get_start(irq));
|
||
|
else
|
||
|
device_printf(dev, "Error %d irq %ld\n", err,
|
||
|
rman_get_start(irq));
|
||
|
return (err);
|
||
|
}
|
||
|
|
||
|
static int
|
||
|
plxic_teardown_intr(device_t dev, device_t child, struct resource *irq,
|
||
|
void *cookie)
|
||
|
{
|
||
|
struct pccard_devinfo *devi = device_get_ivars(child);
|
||
|
|
||
|
plxic_cinfo.mapirq(devi->slt, 0);
|
||
|
return (bus_generic_teardown_intr(dev, child, irq, cookie));
|
||
|
}
|
||
|
|
||
|
static int
|
||
|
plxic_set_res_flags(device_t bus, device_t child, int restype, int rid,
|
||
|
u_long value)
|
||
|
{
|
||
|
struct pccard_devinfo *devi = device_get_ivars(child);
|
||
|
int err = 0;
|
||
|
|
||
|
switch (restype) {
|
||
|
case SYS_RES_MEMORY: {
|
||
|
struct mem_desc *mp = &devi->slt->mem[rid];
|
||
|
switch (value) {
|
||
|
case PCCARD_A_MEM_COM:
|
||
|
mp->flags &= ~MDF_ATTR;
|
||
|
break;
|
||
|
case PCCARD_A_MEM_ATTR:
|
||
|
mp->flags |= MDF_ATTR;
|
||
|
break;
|
||
|
case PCCARD_A_MEM_8BIT:
|
||
|
mp->flags &= ~MDF_16BITS;
|
||
|
break;
|
||
|
case PCCARD_A_MEM_16BIT:
|
||
|
mp->flags |= MDF_16BITS;
|
||
|
break;
|
||
|
}
|
||
|
err = plxic_cinfo.mapmem(devi->slt, rid);
|
||
|
break;
|
||
|
}
|
||
|
default:
|
||
|
err = EOPNOTSUPP;
|
||
|
}
|
||
|
return (err);
|
||
|
}
|
||
|
|
||
|
static int
|
||
|
plxic_get_res_flags(device_t bus, device_t child, int restype, int rid,
|
||
|
u_long *value)
|
||
|
{
|
||
|
struct pccard_devinfo *devi = device_get_ivars(child);
|
||
|
int err = 0;
|
||
|
|
||
|
if (value == 0)
|
||
|
return (ENOMEM);
|
||
|
|
||
|
switch (restype) {
|
||
|
case SYS_RES_IOPORT: {
|
||
|
struct io_desc *ip = &devi->slt->io[rid];
|
||
|
*value = ip->flags;
|
||
|
break;
|
||
|
}
|
||
|
case SYS_RES_MEMORY: {
|
||
|
struct mem_desc *mp = &devi->slt->mem[rid];
|
||
|
*value = mp->flags;
|
||
|
break;
|
||
|
}
|
||
|
default:
|
||
|
err = EOPNOTSUPP;
|
||
|
}
|
||
|
return (err);
|
||
|
}
|
||
|
|
||
|
static int
|
||
|
plxic_set_memory_offset(device_t bus, device_t child, int rid,
|
||
|
u_int32_t offset, u_int32_t *deltap)
|
||
|
{
|
||
|
struct pccard_devinfo *devi = device_get_ivars(child);
|
||
|
struct mem_desc *mp = &devi->slt->mem[rid];
|
||
|
|
||
|
mp->card = offset;
|
||
|
if (deltap)
|
||
|
*deltap = 0; /* XXX BAD XXX */
|
||
|
return (plxic_cinfo.mapmem(devi->slt, rid));
|
||
|
}
|
||
|
|
||
|
static int
|
||
|
plxic_get_memory_offset(device_t bus, device_t child, int rid,
|
||
|
u_int32_t *offset)
|
||
|
{
|
||
|
struct pccard_devinfo *devi = device_get_ivars(child);
|
||
|
struct mem_desc *mp = &devi->slt->mem[rid];
|
||
|
|
||
|
if (offset == 0)
|
||
|
return (ENOMEM);
|
||
|
|
||
|
*offset = mp->card;
|
||
|
|
||
|
return (0);
|
||
|
}
|
||
|
|
||
|
static device_method_t plxic_methods[] = {
|
||
|
/* Device interface */
|
||
|
DEVMETHOD(device_probe, plxic_probe),
|
||
|
DEVMETHOD(device_attach, plxic_attach),
|
||
|
DEVMETHOD(device_detach, bus_generic_detach),
|
||
|
DEVMETHOD(device_shutdown, bus_generic_shutdown),
|
||
|
DEVMETHOD(device_suspend, bus_generic_suspend),
|
||
|
DEVMETHOD(device_resume, bus_generic_resume),
|
||
|
|
||
|
/* Bus interface */
|
||
|
DEVMETHOD(bus_print_child, bus_generic_print_child),
|
||
|
DEVMETHOD(bus_alloc_resource, bus_generic_alloc_resource),
|
||
|
DEVMETHOD(bus_release_resource, bus_generic_release_resource),
|
||
|
DEVMETHOD(bus_activate_resource, plxic_activate_resource),
|
||
|
DEVMETHOD(bus_deactivate_resource, plxic_deactivate_resource),
|
||
|
DEVMETHOD(bus_setup_intr, plxic_setup_intr),
|
||
|
DEVMETHOD(bus_teardown_intr, plxic_teardown_intr),
|
||
|
|
||
|
/* Card interface */
|
||
|
DEVMETHOD(card_set_res_flags, plxic_set_res_flags),
|
||
|
DEVMETHOD(card_get_res_flags, plxic_get_res_flags),
|
||
|
DEVMETHOD(card_set_memory_offset, plxic_set_memory_offset),
|
||
|
DEVMETHOD(card_get_memory_offset, plxic_get_memory_offset),
|
||
|
|
||
|
{ 0, 0 }
|
||
|
};
|
||
|
|
||
|
devclass_t plxic_devclass;
|
||
|
|
||
|
static driver_t plxic_driver = {
|
||
|
"plxic",
|
||
|
plxic_methods,
|
||
|
sizeof(struct plxic_slot)
|
||
|
};
|
||
|
|
||
|
DRIVER_MODULE(plxic, isa, plxic_driver, plxic_devclass, 0, 0);
|