input/joystick/db9.c

128 static void db9_saturn_write_sub(struct parport *port, int type, unsigned char data, int powered, int pwr_sub)
134 		c = 0x80 | 0x30 | (powered ? 0x08 : 0) | (pwr_sub ? 0x04 : 0) | data;
138 		c = 0x40 | data << 4 | (powered ? 0x08 : 0) | (pwr_sub ? 0x04 : 0) | 0x03;
142 		c = ((((data & 2) ? 2 : 0) | ((data & 1) ? 4 : 0)) ^ 0x02) | !powered;
171 static unsigned char db9_saturn_read_analog(struct parport *port, int type, int powered)
175 	db9_saturn_write_sub(port, type, 0, powered, 0);
178 	db9_saturn_write_sub(port, type, 2, powered, 0);
188 static unsigned char db9_saturn_read_packet(struct parport *port, unsigned char *data, int type, int powered)
193 	db9_saturn_write_sub(port, type, 3, powered, 0);
201 		db9_saturn_write_sub(port, type, 0, powered, 1);
203 		db9_saturn_write_sub(port, type, 2, powered, 1);
205 		db9_saturn_write_sub(port, type, 1, powered, 1);
207 		db9_saturn_write_sub(port, type, 3, powered, 1);
213 		db9_saturn_write_sub(port, type, 2, powered, 0);
215 		data[0] = db9_saturn_read_analog(port, type, powered);
219 				data[i + 1] = db9_saturn_read_analog(port, type, powered);
220 			db9_saturn_write_sub(port, type, 3, powered, 0);
224 			if (db9_saturn_read_analog(port, type, powered) != 0x60)
227 				data[i] = db9_saturn_read_analog(port, type, powered);
231 						data[i + j + 1] = db9_saturn_read_analog(port, type, powered);
233 			db9_saturn_write_sub(port, type, 3, powered, 0);
238 		db9_saturn_write_sub(port, type, 2, powered, 0);
240 		tmp = db9_saturn_read_analog(port, type, powered);
243 				data[i + 1] = db9_saturn_read_analog(port, type, powered);
244 			db9_saturn_write_sub(port, type, 3, powered, 0);