adf4e10555
The .remove() callback for a platform driver returns an int which makes many driver authors wrongly assume it's possible to do error handling by returning an error code. However the value returned is ignored (apart from emitting a warning) and this typically results in resource leaks. To improve here there is a quest to make the remove callback return void. In the first step of this quest all drivers are converted to .remove_new(), which already returns void. Eventually after all drivers are converted, .remove_new() will be renamed to .remove(). Trivially convert this driver from always returning zero in the remove callback to the void returning variant. Signed-off-by: Uwe Kleine-König <u.kleine-koenig@pengutronix.de> Link: https://lore.kernel.org/r/75b3b8f498d6079c974bd47c763c589b9d2c00f6.1702933181.git.u.kleine-koenig@pengutronix.de Signed-off-by: Greg Kroah-Hartman <gregkh@linuxfoundation.org>
245 lines
6.1 KiB
C
245 lines
6.1 KiB
C
// SPDX-License-Identifier: GPL-2.0-only
|
|
/* Low-level parallel port routines for the Amiga built-in port
|
|
*
|
|
* Author: Joerg Dorchain <joerg@dorchain.net>
|
|
*
|
|
* This is a complete rewrite of the code, but based heaviy upon the old
|
|
* lp_intern. code.
|
|
*
|
|
* The built-in Amiga parallel port provides one port at a fixed address
|
|
* with 8 bidirectional data lines (D0 - D7) and 3 bidirectional status
|
|
* lines (BUSY, POUT, SEL), 1 output control line /STROBE (raised automatically
|
|
* in hardware when the data register is accessed), and 1 input control line
|
|
* /ACK, able to cause an interrupt, but both not directly settable by
|
|
* software.
|
|
*/
|
|
|
|
#include <linux/module.h>
|
|
#include <linux/init.h>
|
|
#include <linux/parport.h>
|
|
#include <linux/ioport.h>
|
|
#include <linux/interrupt.h>
|
|
#include <linux/platform_device.h>
|
|
|
|
#include <asm/setup.h>
|
|
#include <asm/amigahw.h>
|
|
#include <asm/irq.h>
|
|
#include <asm/io.h>
|
|
#include <asm/amigaints.h>
|
|
|
|
#undef DEBUG
|
|
|
|
static void amiga_write_data(struct parport *p, unsigned char data)
|
|
{
|
|
pr_debug("write_data %c\n", data);
|
|
/* Triggers also /STROBE. This behavior cannot be changed */
|
|
ciaa.prb = data;
|
|
mb();
|
|
}
|
|
|
|
static unsigned char amiga_read_data(struct parport *p)
|
|
{
|
|
/* Triggers also /STROBE. This behavior cannot be changed */
|
|
return ciaa.prb;
|
|
}
|
|
|
|
static unsigned char control_amiga_to_pc(unsigned char control)
|
|
{
|
|
return PARPORT_CONTROL_SELECT |
|
|
PARPORT_CONTROL_AUTOFD | PARPORT_CONTROL_STROBE;
|
|
/* fake value: interrupt enable, select in, no reset,
|
|
no autolf, no strobe - seems to be closest the wiring diagram */
|
|
}
|
|
|
|
static void amiga_write_control(struct parport *p, unsigned char control)
|
|
{
|
|
pr_debug("write_control %02x\n", control);
|
|
/* No implementation possible */
|
|
}
|
|
|
|
static unsigned char amiga_read_control( struct parport *p)
|
|
{
|
|
pr_debug("read_control\n");
|
|
return control_amiga_to_pc(0);
|
|
}
|
|
|
|
static unsigned char amiga_frob_control( struct parport *p, unsigned char mask, unsigned char val)
|
|
{
|
|
unsigned char old;
|
|
|
|
pr_debug("frob_control mask %02x, value %02x\n", mask, val);
|
|
old = amiga_read_control(p);
|
|
amiga_write_control(p, (old & ~mask) ^ val);
|
|
return old;
|
|
}
|
|
|
|
static unsigned char status_amiga_to_pc(unsigned char status)
|
|
{
|
|
unsigned char ret = PARPORT_STATUS_BUSY | PARPORT_STATUS_ACK | PARPORT_STATUS_ERROR;
|
|
|
|
if (status & 1) /* Busy */
|
|
ret &= ~PARPORT_STATUS_BUSY;
|
|
if (status & 2) /* PaperOut */
|
|
ret |= PARPORT_STATUS_PAPEROUT;
|
|
if (status & 4) /* Selected */
|
|
ret |= PARPORT_STATUS_SELECT;
|
|
/* the rest is not connected or handled autonomously in hardware */
|
|
|
|
return ret;
|
|
}
|
|
|
|
static unsigned char amiga_read_status(struct parport *p)
|
|
{
|
|
unsigned char status;
|
|
|
|
status = status_amiga_to_pc(ciab.pra & 7);
|
|
pr_debug("read_status %02x\n", status);
|
|
return status;
|
|
}
|
|
|
|
static void amiga_enable_irq(struct parport *p)
|
|
{
|
|
enable_irq(IRQ_AMIGA_CIAA_FLG);
|
|
}
|
|
|
|
static void amiga_disable_irq(struct parport *p)
|
|
{
|
|
disable_irq(IRQ_AMIGA_CIAA_FLG);
|
|
}
|
|
|
|
static void amiga_data_forward(struct parport *p)
|
|
{
|
|
pr_debug("forward\n");
|
|
ciaa.ddrb = 0xff; /* all pins output */
|
|
mb();
|
|
}
|
|
|
|
static void amiga_data_reverse(struct parport *p)
|
|
{
|
|
pr_debug("reverse\n");
|
|
ciaa.ddrb = 0; /* all pins input */
|
|
mb();
|
|
}
|
|
|
|
static void amiga_init_state(struct pardevice *dev, struct parport_state *s)
|
|
{
|
|
s->u.amiga.data = 0;
|
|
s->u.amiga.datadir = 255;
|
|
s->u.amiga.status = 0;
|
|
s->u.amiga.statusdir = 0;
|
|
}
|
|
|
|
static void amiga_save_state(struct parport *p, struct parport_state *s)
|
|
{
|
|
mb();
|
|
s->u.amiga.data = ciaa.prb;
|
|
s->u.amiga.datadir = ciaa.ddrb;
|
|
s->u.amiga.status = ciab.pra & 7;
|
|
s->u.amiga.statusdir = ciab.ddra & 7;
|
|
mb();
|
|
}
|
|
|
|
static void amiga_restore_state(struct parport *p, struct parport_state *s)
|
|
{
|
|
mb();
|
|
ciaa.prb = s->u.amiga.data;
|
|
ciaa.ddrb = s->u.amiga.datadir;
|
|
ciab.pra |= (ciab.pra & 0xf8) | s->u.amiga.status;
|
|
ciab.ddra |= (ciab.ddra & 0xf8) | s->u.amiga.statusdir;
|
|
mb();
|
|
}
|
|
|
|
static struct parport_operations pp_amiga_ops = {
|
|
.write_data = amiga_write_data,
|
|
.read_data = amiga_read_data,
|
|
|
|
.write_control = amiga_write_control,
|
|
.read_control = amiga_read_control,
|
|
.frob_control = amiga_frob_control,
|
|
|
|
.read_status = amiga_read_status,
|
|
|
|
.enable_irq = amiga_enable_irq,
|
|
.disable_irq = amiga_disable_irq,
|
|
|
|
.data_forward = amiga_data_forward,
|
|
.data_reverse = amiga_data_reverse,
|
|
|
|
.init_state = amiga_init_state,
|
|
.save_state = amiga_save_state,
|
|
.restore_state = amiga_restore_state,
|
|
|
|
.epp_write_data = parport_ieee1284_epp_write_data,
|
|
.epp_read_data = parport_ieee1284_epp_read_data,
|
|
.epp_write_addr = parport_ieee1284_epp_write_addr,
|
|
.epp_read_addr = parport_ieee1284_epp_read_addr,
|
|
|
|
.ecp_write_data = parport_ieee1284_ecp_write_data,
|
|
.ecp_read_data = parport_ieee1284_ecp_read_data,
|
|
.ecp_write_addr = parport_ieee1284_ecp_write_addr,
|
|
|
|
.compat_write_data = parport_ieee1284_write_compat,
|
|
.nibble_read_data = parport_ieee1284_read_nibble,
|
|
.byte_read_data = parport_ieee1284_read_byte,
|
|
|
|
.owner = THIS_MODULE,
|
|
};
|
|
|
|
/* ----------- Initialisation code --------------------------------- */
|
|
|
|
static int __init amiga_parallel_probe(struct platform_device *pdev)
|
|
{
|
|
struct parport *p;
|
|
int err;
|
|
|
|
ciaa.ddrb = 0xff;
|
|
ciab.ddra &= 0xf8;
|
|
mb();
|
|
|
|
p = parport_register_port((unsigned long)&ciaa.prb, IRQ_AMIGA_CIAA_FLG,
|
|
PARPORT_DMA_NONE, &pp_amiga_ops);
|
|
if (!p)
|
|
return -EBUSY;
|
|
|
|
err = request_irq(IRQ_AMIGA_CIAA_FLG, parport_irq_handler, 0, p->name,
|
|
p);
|
|
if (err)
|
|
goto out_irq;
|
|
|
|
pr_info("%s: Amiga built-in port using irq\n", p->name);
|
|
/* XXX: set operating mode */
|
|
parport_announce_port(p);
|
|
|
|
platform_set_drvdata(pdev, p);
|
|
|
|
return 0;
|
|
|
|
out_irq:
|
|
parport_put_port(p);
|
|
return err;
|
|
}
|
|
|
|
static void __exit amiga_parallel_remove(struct platform_device *pdev)
|
|
{
|
|
struct parport *port = platform_get_drvdata(pdev);
|
|
|
|
parport_remove_port(port);
|
|
if (port->irq != PARPORT_IRQ_NONE)
|
|
free_irq(IRQ_AMIGA_CIAA_FLG, port);
|
|
parport_put_port(port);
|
|
}
|
|
|
|
static struct platform_driver amiga_parallel_driver = {
|
|
.remove_new = __exit_p(amiga_parallel_remove),
|
|
.driver = {
|
|
.name = "amiga-parallel",
|
|
},
|
|
};
|
|
|
|
module_platform_driver_probe(amiga_parallel_driver, amiga_parallel_probe);
|
|
|
|
MODULE_AUTHOR("Joerg Dorchain <joerg@dorchain.net>");
|
|
MODULE_DESCRIPTION("Parport Driver for Amiga builtin Port");
|
|
MODULE_LICENSE("GPL");
|
|
MODULE_ALIAS("platform:amiga-parallel");
|