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, control: (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: IRQ_MFP_BUSY); |
111 | } |
112 | |
113 | static void |
114 | parport_atari_disable_irq(struct parport *p) |
115 | { |
116 | disable_irq(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: IRQ_MFP_BUSY, handler: parport_irq_handler, flags: 0, name: p->name, |
197 | dev: 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 (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(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) |
225 | |