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