linux-imx

/* linux/drivers/parport/parport_ax88796.c

 *

 * (c) 2005,2006 Simtec Electronics

 *  Ben Dooks <ben@simtec.co.uk>

 *

 * This program is free software; you can redistribute it and/or modify

 * it under the terms of the GNU General Public License version 2 as

 * published by the Free Software Foundation.

 *

*/

​

#include <linux/module.h>

#include <linux/kernel.h>

#include <linux/parport.h>

#include <linux/interrupt.h>

#include <linux/errno.h>

#include <linux/platform_device.h>

#include <linux/slab.h>

​

#include <asm/io.h>

#include <asm/irq.h>

​

#define AX_SPR_BUSY     (1<<7)

#define AX_SPR_ACK      (1<<6)

#define AX_SPR_PE       (1<<5)

#define AX_SPR_SLCT     (1<<4)

#define AX_SPR_ERR      (1<<3)

​

#define AX_CPR_nDOE     (1<<5)

#define AX_CPR_SLCTIN       (1<<3)

#define AX_CPR_nINIT        (1<<2)

#define AX_CPR_ATFD     (1<<1)

#define AX_CPR_STRB     (1<<0)

​

struct ax_drvdata {

    struct parport      *parport;

    struct parport_state     suspend;

​

    struct device       *dev;

    struct resource     *io;

​

    unsigned char        irq_enabled;

​

    void __iomem        *base;

    void __iomem        *spp_data;

    void __iomem        *spp_spr;

    void __iomem        *spp_cpr;

};

​

static inline struct ax_drvdata *pp_to_drv(struct parport *p)

{

    return p->private_data;

}

​

static unsigned char

parport_ax88796_read_data(struct parport *p)

{

    struct ax_drvdata *dd = pp_to_drv(p);

​

    return readb(dd->spp_data);

}

​

static void

parport_ax88796_write_data(struct parport *p, unsigned char data)

{

    struct ax_drvdata *dd = pp_to_drv(p);

​

    writeb(data, dd->spp_data);

}

​

static unsigned char

parport_ax88796_read_control(struct parport *p)

{

    struct ax_drvdata *dd = pp_to_drv(p);

    unsigned int cpr = readb(dd->spp_cpr);

    unsigned int ret = 0;

​

    if (!(cpr & AX_CPR_STRB))

        ret |= PARPORT_CONTROL_STROBE;

​

    if (!(cpr & AX_CPR_ATFD))

        ret |= PARPORT_CONTROL_AUTOFD;

​

    if (cpr & AX_CPR_nINIT)

        ret |= PARPORT_CONTROL_INIT;

​

    if (!(cpr & AX_CPR_SLCTIN))

        ret |= PARPORT_CONTROL_SELECT;

​

    return ret;

}

​