drivers/parport/parport_atari.c

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