Blame view
drivers/parport/parport_atari.c
5.61 KB
1da177e4c Linux-2.6.12-rc2 |
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 |
/* Low-level parallel port routines for the Atari builtin port * * Author: Andreas Schwab <schwab@issan.informatik.uni-dortmund.de> * * Based on parport_amiga.c. * * The built-in Atari parallel port provides one port at a fixed address * with 8 output data lines (D0 - D7), 1 output control line (STROBE) * and 1 input status line (BUSY) able to cause an interrupt. */ #include <linux/module.h> #include <linux/init.h> #include <linux/parport.h> #include <linux/interrupt.h> #include <asm/setup.h> #include <asm/atarihw.h> #include <asm/irq.h> #include <asm/atariints.h> static struct parport *this_port = NULL; static unsigned char parport_atari_read_data(struct parport *p) { unsigned long flags; unsigned char data; local_irq_save(flags); sound_ym.rd_data_reg_sel = 15; data = sound_ym.rd_data_reg_sel; local_irq_restore(flags); return data; } static void parport_atari_write_data(struct parport *p, unsigned char data) { unsigned long flags; local_irq_save(flags); sound_ym.rd_data_reg_sel = 15; sound_ym.wd_data = data; local_irq_restore(flags); } static unsigned char parport_atari_read_control(struct parport *p) { unsigned long flags; unsigned char control = 0; local_irq_save(flags); sound_ym.rd_data_reg_sel = 14; if (!(sound_ym.rd_data_reg_sel & (1 << 5))) control = PARPORT_CONTROL_STROBE; local_irq_restore(flags); return control; } static void parport_atari_write_control(struct parport *p, unsigned char control) { unsigned long flags; local_irq_save(flags); sound_ym.rd_data_reg_sel = 14; if (control & PARPORT_CONTROL_STROBE) sound_ym.wd_data = sound_ym.rd_data_reg_sel & ~(1 << 5); else sound_ym.wd_data = sound_ym.rd_data_reg_sel | (1 << 5); local_irq_restore(flags); } static unsigned char parport_atari_frob_control(struct parport *p, unsigned char mask, unsigned char val) { unsigned char old = parport_atari_read_control(p); parport_atari_write_control(p, (old & ~mask) ^ val); return old; } static unsigned char parport_atari_read_status(struct parport *p) { |
3d92e8f3a m68k: atari - Ren... |
87 |
return ((st_mfp.par_dt_reg & 1 ? 0 : PARPORT_STATUS_BUSY) | |
1da177e4c Linux-2.6.12-rc2 |
88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 |
PARPORT_STATUS_SELECT | PARPORT_STATUS_ERROR); } static void parport_atari_init_state(struct pardevice *d, struct parport_state *s) { } static void parport_atari_save_state(struct parport *p, struct parport_state *s) { } static void parport_atari_restore_state(struct parport *p, struct parport_state *s) { } |
1da177e4c Linux-2.6.12-rc2 |
105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 145 146 147 148 149 150 151 152 153 154 155 156 157 158 159 160 161 162 163 164 165 166 167 168 169 170 171 172 173 174 175 176 177 178 179 180 181 182 183 184 185 186 187 188 189 190 191 192 193 194 |
static void parport_atari_enable_irq(struct parport *p) { enable_irq(IRQ_MFP_BUSY); } static void parport_atari_disable_irq(struct parport *p) { disable_irq(IRQ_MFP_BUSY); } static void parport_atari_data_forward(struct parport *p) { unsigned long flags; local_irq_save(flags); /* Soundchip port B as output. */ sound_ym.rd_data_reg_sel = 7; sound_ym.wd_data = sound_ym.rd_data_reg_sel | 0x40; local_irq_restore(flags); } static void parport_atari_data_reverse(struct parport *p) { #if 0 /* too dangerous, can kill sound chip */ unsigned long flags; local_irq_save(flags); /* Soundchip port B as input. */ sound_ym.rd_data_reg_sel = 7; sound_ym.wd_data = sound_ym.rd_data_reg_sel & ~0x40; local_irq_restore(flags); #endif } static struct parport_operations parport_atari_ops = { .write_data = parport_atari_write_data, .read_data = parport_atari_read_data, .write_control = parport_atari_write_control, .read_control = parport_atari_read_control, .frob_control = parport_atari_frob_control, .read_status = parport_atari_read_status, .enable_irq = parport_atari_enable_irq, .disable_irq = parport_atari_disable_irq, .data_forward = parport_atari_data_forward, .data_reverse = parport_atari_data_reverse, .init_state = parport_atari_init_state, .save_state = parport_atari_save_state, .restore_state = parport_atari_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, }; static int __init parport_atari_init(void) { struct parport *p; unsigned long flags; if (MACH_IS_ATARI) { local_irq_save(flags); /* Soundchip port A/B as output. */ sound_ym.rd_data_reg_sel = 7; sound_ym.wd_data = (sound_ym.rd_data_reg_sel & 0x3f) | 0xc0; /* STROBE high. */ sound_ym.rd_data_reg_sel = 14; sound_ym.wd_data = sound_ym.rd_data_reg_sel | (1 << 5); local_irq_restore(flags); /* MFP port I0 as input. */ |
3d92e8f3a m68k: atari - Ren... |
195 |
st_mfp.data_dir &= ~1; |
1da177e4c Linux-2.6.12-rc2 |
196 |
/* MFP port I0 interrupt on high->low edge. */ |
3d92e8f3a m68k: atari - Ren... |
197 |
st_mfp.active_edge &= ~1; |
1da177e4c Linux-2.6.12-rc2 |
198 199 200 201 202 |
p = parport_register_port((unsigned long)&sound_ym.wd_data, IRQ_MFP_BUSY, PARPORT_DMA_NONE, &parport_atari_ops); if (!p) return -ENODEV; |
3f2e40df0 [PARPORT] Consoli... |
203 |
if (request_irq(IRQ_MFP_BUSY, parport_irq_handler, |
1da177e4c Linux-2.6.12-rc2 |
204 205 206 207 208 209 210 211 212 213 214 215 216 217 218 219 220 221 222 223 224 225 226 227 228 229 230 231 232 233 |
IRQ_TYPE_SLOW, p->name, p)) { parport_put_port (p); return -ENODEV; } this_port = p; printk(KERN_INFO "%s: Atari built-in port using irq ", p->name); parport_announce_port (p); return 0; } return -ENODEV; } static void __exit parport_atari_exit(void) { parport_remove_port(this_port); if (this_port->irq != PARPORT_IRQ_NONE) free_irq(IRQ_MFP_BUSY, this_port); parport_put_port(this_port); } MODULE_AUTHOR("Andreas Schwab"); MODULE_DESCRIPTION("Parport Driver for Atari builtin Port"); MODULE_SUPPORTED_DEVICE("Atari builtin Parallel Port"); MODULE_LICENSE("GPL"); module_init(parport_atari_init) module_exit(parport_atari_exit) |