11da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* Low-level parallel port routines for the Amiga built-in port 21da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 31da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Author: Joerg Dorchain <joerg@dorchain.net> 41da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 51da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * This is a complete rewrite of the code, but based heaviy upon the old 61da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * lp_intern. code. 71da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 81da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * The built-in Amiga parallel port provides one port at a fixed address 91da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * with 8 bidirectional data lines (D0 - D7) and 3 bidirectional status 101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * lines (BUSY, POUT, SEL), 1 output control line /STROBE (raised automatically 111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * in hardware when the data register is accessed), and 1 input control line 121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * /ACK, able to cause an interrupt, but both not directly settable by 131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * software. 141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/module.h> 171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/init.h> 181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/parport.h> 191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/ioport.h> 201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/interrupt.h> 216f8221c26be5d80f749b1b6c2e7c8456fefb5250Geert Uytterhoeven#include <linux/platform_device.h> 226f8221c26be5d80f749b1b6c2e7c8456fefb5250Geert Uytterhoeven 231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <asm/setup.h> 241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <asm/amigahw.h> 251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <asm/irq.h> 261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <asm/io.h> 271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <asm/amigaints.h> 281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#undef DEBUG 301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#ifdef DEBUG 311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define DPRINTK printk 321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#else 331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define DPRINTK(x...) do { } while (0) 341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#endif 351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void amiga_write_data(struct parport *p, unsigned char data) 381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds DPRINTK(KERN_DEBUG "write_data %c\n",data); 401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Triggers also /STROBE. This behavior cannot be changed */ 411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ciaa.prb = data; 421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mb(); 431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic unsigned char amiga_read_data(struct parport *p) 461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* Triggers also /STROBE. This behavior cannot be changed */ 481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ciaa.prb; 491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic unsigned char control_amiga_to_pc(unsigned char control) 521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return PARPORT_CONTROL_SELECT | 541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds PARPORT_CONTROL_AUTOFD | PARPORT_CONTROL_STROBE; 551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* fake value: interrupt enable, select in, no reset, 561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds no autolf, no strobe - seems to be closest the wiring diagram */ 571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void amiga_write_control(struct parport *p, unsigned char control) 601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds DPRINTK(KERN_DEBUG "write_control %02x\n",control); 621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* No implementation possible */ 631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic unsigned char amiga_read_control( struct parport *p) 661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds DPRINTK(KERN_DEBUG "read_control \n"); 681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return control_amiga_to_pc(0); 691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic unsigned char amiga_frob_control( struct parport *p, unsigned char mask, unsigned char val) 721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned char old; 741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds DPRINTK(KERN_DEBUG "frob_control mask %02x, value %02x\n",mask,val); 761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds old = amiga_read_control(p); 771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds amiga_write_control(p, (old & ~mask) ^ val); 781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return old; 791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic unsigned char status_amiga_to_pc(unsigned char status) 821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned char ret = PARPORT_STATUS_BUSY | PARPORT_STATUS_ACK | PARPORT_STATUS_ERROR; 841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (status & 1) /* Busy */ 861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ret &= ~PARPORT_STATUS_BUSY; 871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (status & 2) /* PaperOut */ 881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ret |= PARPORT_STATUS_PAPEROUT; 891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (status & 4) /* Selected */ 901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ret |= PARPORT_STATUS_SELECT; 911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* the rest is not connected or handled autonomously in hardware */ 921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return ret; 941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic unsigned char amiga_read_status(struct parport *p) 971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned char status; 991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds status = status_amiga_to_pc(ciab.pra & 7); 1011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds DPRINTK(KERN_DEBUG "read_status %02x\n", status); 1021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return status; 1031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 1041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void amiga_enable_irq(struct parport *p) 1061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 1071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds enable_irq(IRQ_AMIGA_CIAA_FLG); 1081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 1091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void amiga_disable_irq(struct parport *p) 1111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 1121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds disable_irq(IRQ_AMIGA_CIAA_FLG); 1131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 1141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void amiga_data_forward(struct parport *p) 1161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 1171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds DPRINTK(KERN_DEBUG "forward\n"); 1181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ciaa.ddrb = 0xff; /* all pins output */ 1191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mb(); 1201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 1211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void amiga_data_reverse(struct parport *p) 1231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 1241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds DPRINTK(KERN_DEBUG "reverse\n"); 1251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ciaa.ddrb = 0; /* all pins input */ 1261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mb(); 1271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 1281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void amiga_init_state(struct pardevice *dev, struct parport_state *s) 1301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 1311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds s->u.amiga.data = 0; 1321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds s->u.amiga.datadir = 255; 1331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds s->u.amiga.status = 0; 1341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds s->u.amiga.statusdir = 0; 1351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 1361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void amiga_save_state(struct parport *p, struct parport_state *s) 1381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 1391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mb(); 1401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds s->u.amiga.data = ciaa.prb; 1411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds s->u.amiga.datadir = ciaa.ddrb; 1421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds s->u.amiga.status = ciab.pra & 7; 1431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds s->u.amiga.statusdir = ciab.ddra & 7; 1441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mb(); 1451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 1461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void amiga_restore_state(struct parport *p, struct parport_state *s) 1481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 1491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mb(); 1501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ciaa.prb = s->u.amiga.data; 1511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ciaa.ddrb = s->u.amiga.datadir; 1521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ciab.pra |= (ciab.pra & 0xf8) | s->u.amiga.status; 1531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ciab.ddra |= (ciab.ddra & 0xf8) | s->u.amiga.statusdir; 1541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mb(); 1551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 1561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic struct parport_operations pp_amiga_ops = { 1581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .write_data = amiga_write_data, 1591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .read_data = amiga_read_data, 1601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .write_control = amiga_write_control, 1621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .read_control = amiga_read_control, 1631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .frob_control = amiga_frob_control, 1641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .read_status = amiga_read_status, 1661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .enable_irq = amiga_enable_irq, 1681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .disable_irq = amiga_disable_irq, 1691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .data_forward = amiga_data_forward, 1711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .data_reverse = amiga_data_reverse, 1721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .init_state = amiga_init_state, 1741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .save_state = amiga_save_state, 1751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .restore_state = amiga_restore_state, 1761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .epp_write_data = parport_ieee1284_epp_write_data, 1781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .epp_read_data = parport_ieee1284_epp_read_data, 1791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .epp_write_addr = parport_ieee1284_epp_write_addr, 1801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .epp_read_addr = parport_ieee1284_epp_read_addr, 1811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .ecp_write_data = parport_ieee1284_ecp_write_data, 1831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .ecp_read_data = parport_ieee1284_ecp_read_data, 1841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .ecp_write_addr = parport_ieee1284_ecp_write_addr, 1851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .compat_write_data = parport_ieee1284_write_compat, 1871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .nibble_read_data = parport_ieee1284_read_nibble, 1881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .byte_read_data = parport_ieee1284_read_byte, 1891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .owner = THIS_MODULE, 1911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 1921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* ----------- Initialisation code --------------------------------- */ 1941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1956f8221c26be5d80f749b1b6c2e7c8456fefb5250Geert Uytterhoevenstatic int __init amiga_parallel_probe(struct platform_device *pdev) 1961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 1971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct parport *p; 1981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int err; 1991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ciaa.ddrb = 0xff; 2011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ciab.ddra &= 0xf8; 2021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mb(); 2031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds p = parport_register_port((unsigned long)&ciaa.prb, IRQ_AMIGA_CIAA_FLG, 2051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds PARPORT_DMA_NONE, &pp_amiga_ops); 2061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!p) 2076f8221c26be5d80f749b1b6c2e7c8456fefb5250Geert Uytterhoeven return -EBUSY; 2081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2096f8221c26be5d80f749b1b6c2e7c8456fefb5250Geert Uytterhoeven err = request_irq(IRQ_AMIGA_CIAA_FLG, parport_irq_handler, 0, p->name, 2106f8221c26be5d80f749b1b6c2e7c8456fefb5250Geert Uytterhoeven p); 2111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (err) 2121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto out_irq; 2131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds printk(KERN_INFO "%s: Amiga built-in port using irq\n", p->name); 2151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* XXX: set operating mode */ 2161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds parport_announce_port(p); 2171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2186f8221c26be5d80f749b1b6c2e7c8456fefb5250Geert Uytterhoeven platform_set_drvdata(pdev, p); 2196f8221c26be5d80f749b1b6c2e7c8456fefb5250Geert Uytterhoeven 2201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 2211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsout_irq: 2231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds parport_put_port(p); 2241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return err; 2251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 2261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2276f8221c26be5d80f749b1b6c2e7c8456fefb5250Geert Uytterhoevenstatic int __exit amiga_parallel_remove(struct platform_device *pdev) 2286f8221c26be5d80f749b1b6c2e7c8456fefb5250Geert Uytterhoeven{ 2296f8221c26be5d80f749b1b6c2e7c8456fefb5250Geert Uytterhoeven struct parport *port = platform_get_drvdata(pdev); 2306f8221c26be5d80f749b1b6c2e7c8456fefb5250Geert Uytterhoeven 2316f8221c26be5d80f749b1b6c2e7c8456fefb5250Geert Uytterhoeven parport_remove_port(port); 2326f8221c26be5d80f749b1b6c2e7c8456fefb5250Geert Uytterhoeven if (port->irq != PARPORT_IRQ_NONE) 2336f8221c26be5d80f749b1b6c2e7c8456fefb5250Geert Uytterhoeven free_irq(IRQ_AMIGA_CIAA_FLG, port); 2346f8221c26be5d80f749b1b6c2e7c8456fefb5250Geert Uytterhoeven parport_put_port(port); 2356f8221c26be5d80f749b1b6c2e7c8456fefb5250Geert Uytterhoeven return 0; 2366f8221c26be5d80f749b1b6c2e7c8456fefb5250Geert Uytterhoeven} 2376f8221c26be5d80f749b1b6c2e7c8456fefb5250Geert Uytterhoeven 2386f8221c26be5d80f749b1b6c2e7c8456fefb5250Geert Uytterhoevenstatic struct platform_driver amiga_parallel_driver = { 2396f8221c26be5d80f749b1b6c2e7c8456fefb5250Geert Uytterhoeven .remove = __exit_p(amiga_parallel_remove), 2406f8221c26be5d80f749b1b6c2e7c8456fefb5250Geert Uytterhoeven .driver = { 2416f8221c26be5d80f749b1b6c2e7c8456fefb5250Geert Uytterhoeven .name = "amiga-parallel", 2426f8221c26be5d80f749b1b6c2e7c8456fefb5250Geert Uytterhoeven .owner = THIS_MODULE, 2436f8221c26be5d80f749b1b6c2e7c8456fefb5250Geert Uytterhoeven }, 2446f8221c26be5d80f749b1b6c2e7c8456fefb5250Geert Uytterhoeven}; 2456f8221c26be5d80f749b1b6c2e7c8456fefb5250Geert Uytterhoeven 2465bcdf0ce2bf31b09b8707f972c193c6118385526Fabio Porceddamodule_platform_driver_probe(amiga_parallel_driver, amiga_parallel_probe); 2471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus TorvaldsMODULE_AUTHOR("Joerg Dorchain <joerg@dorchain.net>"); 2491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus TorvaldsMODULE_DESCRIPTION("Parport Driver for Amiga builtin Port"); 2501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus TorvaldsMODULE_SUPPORTED_DEVICE("Amiga builtin Parallel Port"); 2511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus TorvaldsMODULE_LICENSE("GPL"); 2526f8221c26be5d80f749b1b6c2e7c8456fefb5250Geert UytterhoevenMODULE_ALIAS("platform:amiga-parallel"); 253