f1d19042b0
and local variables, goto labels, and functions declared but not defined.
328 lines
7.5 KiB
C
328 lines
7.5 KiB
C
/*-
|
|
* Copyright (c) 1998 Nicolas Souchu, Marc Bouget
|
|
* 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 AND CONTRIBUTORS ``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 OR CONTRIBUTORS 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.
|
|
*
|
|
* $Id: lpbb.c,v 1.2 1998/11/09 22:22:01 nsouch Exp $
|
|
*
|
|
*/
|
|
|
|
/*
|
|
* I2C Bit-Banging over parallel port
|
|
*
|
|
* See the Official Philips interface description in lpbb(4)
|
|
*/
|
|
|
|
#include <sys/param.h>
|
|
#include <sys/kernel.h>
|
|
#include <sys/systm.h>
|
|
#include <sys/module.h>
|
|
#include <sys/bus.h>
|
|
#include <sys/conf.h>
|
|
#include <sys/buf.h>
|
|
#include <sys/uio.h>
|
|
#include <sys/malloc.h>
|
|
|
|
#include <machine/clock.h>
|
|
|
|
#include <dev/ppbus/ppbconf.h>
|
|
|
|
#include <dev/iicbus/iiconf.h>
|
|
#include <dev/iicbus/iicbus.h>
|
|
|
|
#include "iicbb_if.h"
|
|
|
|
/* iicbus softc */
|
|
struct lpbb_softc {
|
|
|
|
struct ppb_device lpbb_dev;
|
|
};
|
|
|
|
static int lpbb_detect(struct lpbb_softc *);
|
|
|
|
static int lpbb_probe(device_t);
|
|
static int lpbb_attach(device_t);
|
|
static void lpbb_print_child(device_t, device_t);
|
|
|
|
static int lpbb_callback(device_t, int, caddr_t *);
|
|
static void lpbb_setlines(device_t, int, int);
|
|
static int lpbb_getdataline(device_t);
|
|
static int lpbb_reset(device_t, u_char, u_char, u_char *);
|
|
|
|
static devclass_t lpbb_devclass;
|
|
|
|
static device_method_t lpbb_methods[] = {
|
|
/* device interface */
|
|
DEVMETHOD(device_probe, lpbb_probe),
|
|
DEVMETHOD(device_attach, lpbb_attach),
|
|
|
|
/* bus interface */
|
|
DEVMETHOD(bus_print_child, lpbb_print_child),
|
|
|
|
/* iicbb interface */
|
|
DEVMETHOD(iicbb_callback, lpbb_callback),
|
|
DEVMETHOD(iicbb_setlines, lpbb_setlines),
|
|
DEVMETHOD(iicbb_getdataline, lpbb_getdataline),
|
|
DEVMETHOD(iicbb_reset, lpbb_reset),
|
|
|
|
{ 0, 0 }
|
|
};
|
|
|
|
static driver_t lpbb_driver = {
|
|
"lpbb",
|
|
lpbb_methods,
|
|
DRIVER_TYPE_MISC,
|
|
sizeof(struct lpbb_softc),
|
|
};
|
|
|
|
/*
|
|
* Make ourselves visible as a ppbus driver
|
|
*/
|
|
static struct ppb_device *lpbb_ppb_probe(struct ppb_data *ppb);
|
|
static int lpbb_ppb_attach(struct ppb_device *dev);
|
|
|
|
#define MAXLPBB 8 /* XXX not much better! */
|
|
static struct lpbb_softc *lpbbdata[MAXLPBB];
|
|
static int nlpbb = 0;
|
|
|
|
#ifdef KERNEL
|
|
|
|
static struct ppb_driver lpbbdriver = {
|
|
lpbb_ppb_probe, lpbb_ppb_attach, "lpbb"
|
|
};
|
|
DATA_SET(ppbdriver_set, lpbbdriver);
|
|
|
|
#endif /* KERNEL */
|
|
|
|
static int
|
|
lpbb_probe(device_t dev)
|
|
{
|
|
struct lpbb_softc *sc = lpbbdata[device_get_unit(dev)];
|
|
struct lpbb_softc *scdst = (struct lpbb_softc *)device_get_softc(dev);
|
|
|
|
/* XXX copy softc. Yet, ppbus device is sc->lpbb_dev, but will be
|
|
* dev->parent when ppbus will be ported to the new bus architecture */
|
|
bcopy(sc, scdst, sizeof(struct lpbb_softc));
|
|
|
|
device_set_desc(dev, "parallel I2C bit-banging interface");
|
|
|
|
/* probe done by ppbus initialization */
|
|
return (0);
|
|
}
|
|
|
|
static int
|
|
lpbb_attach(device_t dev)
|
|
{
|
|
device_t bitbang, iicbus;
|
|
|
|
/* add generic bit-banging code */
|
|
bitbang = device_add_child(dev, "iicbb", -1, NULL);
|
|
|
|
/* add the iicbus to the tree */
|
|
iicbus = iicbus_alloc_bus(bitbang);
|
|
|
|
device_probe_and_attach(bitbang);
|
|
|
|
/* XXX should be in iicbb_attach! */
|
|
device_probe_and_attach(iicbus);
|
|
|
|
return (0);
|
|
}
|
|
|
|
/*
|
|
* lppbb_ppb_probe()
|
|
*/
|
|
static struct ppb_device *
|
|
lpbb_ppb_probe(struct ppb_data *ppb)
|
|
{
|
|
struct lpbb_softc *sc;
|
|
|
|
sc = (struct lpbb_softc *) malloc(sizeof(struct lpbb_softc),
|
|
M_TEMP, M_NOWAIT);
|
|
if (!sc) {
|
|
printf("lpbb: cannot malloc!\n");
|
|
return (0);
|
|
}
|
|
bzero(sc, sizeof(struct lpbb_softc));
|
|
|
|
lpbbdata[nlpbb] = sc;
|
|
|
|
/*
|
|
* ppbus dependent initialisation.
|
|
*/
|
|
sc->lpbb_dev.id_unit = nlpbb;
|
|
sc->lpbb_dev.name = lpbbdriver.name;
|
|
sc->lpbb_dev.ppb = ppb;
|
|
sc->lpbb_dev.intr = 0;
|
|
|
|
if (!lpbb_detect(sc)) {
|
|
free(sc, M_TEMP);
|
|
return (NULL);
|
|
}
|
|
|
|
/* Ok, go to next device on next probe */
|
|
nlpbb ++;
|
|
|
|
/* XXX wrong according to new bus architecture. ppbus needs to be
|
|
* ported
|
|
*/
|
|
return (&sc->lpbb_dev);
|
|
}
|
|
|
|
static int
|
|
lpbb_ppb_attach(struct ppb_device *dev)
|
|
{
|
|
/* add the parallel port I2C interface to the bus tree */
|
|
if (!device_add_child(root_bus, "lpbb", dev->id_unit, NULL))
|
|
return (0);
|
|
|
|
return (1);
|
|
}
|
|
|
|
static int
|
|
lpbb_callback(device_t dev, int index, caddr_t *data)
|
|
{
|
|
struct lpbb_softc *sc = (struct lpbb_softc *)device_get_softc(dev);
|
|
int error = 0;
|
|
int how;
|
|
|
|
switch (index) {
|
|
case IIC_REQUEST_BUS:
|
|
/* request the ppbus */
|
|
how = *(int *)data;
|
|
error = ppb_request_bus(&sc->lpbb_dev, how);
|
|
break;
|
|
|
|
case IIC_RELEASE_BUS:
|
|
/* release the ppbus */
|
|
error = ppb_release_bus(&sc->lpbb_dev);
|
|
break;
|
|
|
|
default:
|
|
error = EINVAL;
|
|
}
|
|
|
|
return (error);
|
|
}
|
|
|
|
#define SDA_out 0x80
|
|
#define SCL_out 0x08
|
|
#define SDA_in 0x80
|
|
#define SCL_in 0x08
|
|
#define ALIM 0x20
|
|
#define I2CKEY 0x50
|
|
|
|
static int getSDA(struct lpbb_softc *sc)
|
|
{
|
|
if((ppb_rstr(&sc->lpbb_dev)&SDA_in)==SDA_in)
|
|
return 1;
|
|
else
|
|
return 0;
|
|
}
|
|
|
|
static int getSCL(struct lpbb_softc *sc)
|
|
{
|
|
if((ppb_rstr(&sc->lpbb_dev)&SCL_in)==SCL_in)
|
|
return 1;
|
|
else
|
|
return 0;
|
|
}
|
|
|
|
static void setSDA(struct lpbb_softc *sc, char val)
|
|
{
|
|
if(val==0)
|
|
ppb_wdtr(&sc->lpbb_dev, (u_char)SDA_out);
|
|
else
|
|
ppb_wdtr(&sc->lpbb_dev, (u_char)~SDA_out);
|
|
}
|
|
|
|
static void setSCL(struct lpbb_softc *sc, unsigned char val)
|
|
{
|
|
if(val==0)
|
|
ppb_wctr(&sc->lpbb_dev, (u_char)(ppb_rctr(&sc->lpbb_dev)&~SCL_out));
|
|
else
|
|
ppb_wctr(&sc->lpbb_dev, (u_char)(ppb_rctr(&sc->lpbb_dev)|SCL_out));
|
|
}
|
|
|
|
static int lpbb_detect(struct lpbb_softc *sc)
|
|
{
|
|
if (ppb_request_bus(&sc->lpbb_dev, PPB_DONTWAIT)) {
|
|
printf("lpbb: can't allocate ppbus\n");
|
|
return (0);
|
|
}
|
|
|
|
/* reset bus */
|
|
setSDA(sc, 1);
|
|
setSCL(sc, 1);
|
|
|
|
if ((ppb_rstr(&sc->lpbb_dev) & I2CKEY) ||
|
|
((ppb_rstr(&sc->lpbb_dev) & ALIM) != ALIM)) {
|
|
|
|
ppb_release_bus(&sc->lpbb_dev);
|
|
return (0);
|
|
}
|
|
|
|
ppb_release_bus(&sc->lpbb_dev);
|
|
|
|
return (1);
|
|
}
|
|
|
|
static int
|
|
lpbb_reset(device_t dev, u_char speed, u_char addr, u_char * oldaddr)
|
|
{
|
|
struct lpbb_softc *sc = (struct lpbb_softc *)device_get_softc(dev);
|
|
|
|
/* reset bus */
|
|
setSDA(sc, 1);
|
|
setSCL(sc, 1);
|
|
|
|
return (IIC_ENOADDR);
|
|
}
|
|
|
|
static void
|
|
lpbb_setlines(device_t dev, int ctrl, int data)
|
|
{
|
|
struct lpbb_softc *sc = (struct lpbb_softc *)device_get_softc(dev);
|
|
|
|
setSCL(sc, ctrl);
|
|
setSDA(sc, data);
|
|
}
|
|
|
|
static int
|
|
lpbb_getdataline(device_t dev)
|
|
{
|
|
struct lpbb_softc *sc = (struct lpbb_softc *)device_get_softc(dev);
|
|
|
|
return (getSDA(sc));
|
|
}
|
|
|
|
static void
|
|
lpbb_print_child(device_t bus, device_t dev)
|
|
{
|
|
printf(" on %s%d", device_get_name(bus), device_get_unit(bus));
|
|
|
|
return;
|
|
}
|
|
|
|
DRIVER_MODULE(lpbb, root, lpbb_driver, lpbb_devclass, 0, 0);
|