| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1 | /*****************************************************************************/ | 
|  | 2 |  | 
|  | 3 | /* | 
|  | 4 | *	istallion.c  -- stallion intelligent multiport serial driver. | 
|  | 5 | * | 
|  | 6 | *	Copyright (C) 1996-1999  Stallion Technologies | 
|  | 7 | *	Copyright (C) 1994-1996  Greg Ungerer. | 
|  | 8 | * | 
|  | 9 | *	This code is loosely based on the Linux serial driver, written by | 
|  | 10 | *	Linus Torvalds, Theodore T'so and others. | 
|  | 11 | * | 
|  | 12 | *	This program is free software; you can redistribute it and/or modify | 
|  | 13 | *	it under the terms of the GNU General Public License as published by | 
|  | 14 | *	the Free Software Foundation; either version 2 of the License, or | 
|  | 15 | *	(at your option) any later version. | 
|  | 16 | * | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 17 | */ | 
|  | 18 |  | 
|  | 19 | /*****************************************************************************/ | 
|  | 20 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 21 | #include <linux/module.h> | 
|  | 22 | #include <linux/slab.h> | 
|  | 23 | #include <linux/interrupt.h> | 
|  | 24 | #include <linux/tty.h> | 
|  | 25 | #include <linux/tty_flip.h> | 
|  | 26 | #include <linux/serial.h> | 
|  | 27 | #include <linux/cdk.h> | 
|  | 28 | #include <linux/comstats.h> | 
|  | 29 | #include <linux/istallion.h> | 
|  | 30 | #include <linux/ioport.h> | 
|  | 31 | #include <linux/delay.h> | 
|  | 32 | #include <linux/init.h> | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 33 | #include <linux/device.h> | 
|  | 34 | #include <linux/wait.h> | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 35 | #include <linux/eisa.h> | 
| Jiri Slaby | a3f8d9d | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 36 | #include <linux/ctype.h> | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 37 |  | 
|  | 38 | #include <asm/io.h> | 
|  | 39 | #include <asm/uaccess.h> | 
|  | 40 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 41 | #include <linux/pci.h> | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 42 |  | 
|  | 43 | /*****************************************************************************/ | 
|  | 44 |  | 
|  | 45 | /* | 
|  | 46 | *	Define different board types. Not all of the following board types | 
|  | 47 | *	are supported by this driver. But I will use the standard "assigned" | 
|  | 48 | *	board numbers. Currently supported boards are abbreviated as: | 
|  | 49 | *	ECP = EasyConnection 8/64, ONB = ONboard, BBY = Brumby and | 
|  | 50 | *	STAL = Stallion. | 
|  | 51 | */ | 
|  | 52 | #define	BRD_UNKNOWN	0 | 
|  | 53 | #define	BRD_STALLION	1 | 
|  | 54 | #define	BRD_BRUMBY4	2 | 
|  | 55 | #define	BRD_ONBOARD2	3 | 
|  | 56 | #define	BRD_ONBOARD	4 | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 57 | #define	BRD_ONBOARDE	7 | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 58 | #define	BRD_ECP		23 | 
|  | 59 | #define BRD_ECPE	24 | 
|  | 60 | #define	BRD_ECPMC	25 | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 61 | #define	BRD_ECPPCI	29 | 
|  | 62 |  | 
|  | 63 | #define	BRD_BRUMBY	BRD_BRUMBY4 | 
|  | 64 |  | 
|  | 65 | /* | 
|  | 66 | *	Define a configuration structure to hold the board configuration. | 
|  | 67 | *	Need to set this up in the code (for now) with the boards that are | 
|  | 68 | *	to be configured into the system. This is what needs to be modified | 
|  | 69 | *	when adding/removing/modifying boards. Each line entry in the | 
|  | 70 | *	stli_brdconf[] array is a board. Each line contains io/irq/memory | 
|  | 71 | *	ranges for that board (as well as what type of board it is). | 
|  | 72 | *	Some examples: | 
|  | 73 | *		{ BRD_ECP, 0x2a0, 0, 0xcc000, 0, 0 }, | 
|  | 74 | *	This line will configure an EasyConnection 8/64 at io address 2a0, | 
|  | 75 | *	and shared memory address of cc000. Multiple EasyConnection 8/64 | 
|  | 76 | *	boards can share the same shared memory address space. No interrupt | 
|  | 77 | *	is required for this board type. | 
|  | 78 | *	Another example: | 
|  | 79 | *		{ BRD_ECPE, 0x5000, 0, 0x80000000, 0, 0 }, | 
|  | 80 | *	This line will configure an EasyConnection 8/64 EISA in slot 5 and | 
|  | 81 | *	shared memory address of 0x80000000 (2 GByte). Multiple | 
|  | 82 | *	EasyConnection 8/64 EISA boards can share the same shared memory | 
|  | 83 | *	address space. No interrupt is required for this board type. | 
|  | 84 | *	Another example: | 
|  | 85 | *		{ BRD_ONBOARD, 0x240, 0, 0xd0000, 0, 0 }, | 
|  | 86 | *	This line will configure an ONboard (ISA type) at io address 240, | 
|  | 87 | *	and shared memory address of d0000. Multiple ONboards can share | 
|  | 88 | *	the same shared memory address space. No interrupt required. | 
|  | 89 | *	Another example: | 
|  | 90 | *		{ BRD_BRUMBY4, 0x360, 0, 0xc8000, 0, 0 }, | 
|  | 91 | *	This line will configure a Brumby board (any number of ports!) at | 
|  | 92 | *	io address 360 and shared memory address of c8000. All Brumby boards | 
|  | 93 | *	configured into a system must have their own separate io and memory | 
|  | 94 | *	addresses. No interrupt is required. | 
|  | 95 | *	Another example: | 
|  | 96 | *		{ BRD_STALLION, 0x330, 0, 0xd0000, 0, 0 }, | 
|  | 97 | *	This line will configure an original Stallion board at io address 330 | 
|  | 98 | *	and shared memory address d0000 (this would only be valid for a "V4.0" | 
|  | 99 | *	or Rev.O Stallion board). All Stallion boards configured into the | 
|  | 100 | *	system must have their own separate io and memory addresses. No | 
|  | 101 | *	interrupt is required. | 
|  | 102 | */ | 
|  | 103 |  | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 104 | struct stlconf { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 105 | int		brdtype; | 
|  | 106 | int		ioaddr1; | 
|  | 107 | int		ioaddr2; | 
|  | 108 | unsigned long	memaddr; | 
|  | 109 | int		irq; | 
|  | 110 | int		irqtype; | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 111 | }; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 112 |  | 
| Jiri Slaby | 1328d73 | 2006-12-08 02:39:19 -0800 | [diff] [blame] | 113 | static unsigned int stli_nrbrds; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 114 |  | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 115 | /* stli_lock must NOT be taken holding brd_lock */ | 
|  | 116 | static spinlock_t stli_lock;	/* TTY logic lock */ | 
|  | 117 | static spinlock_t brd_lock;	/* Board logic lock */ | 
|  | 118 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 119 | /* | 
|  | 120 | *	There is some experimental EISA board detection code in this driver. | 
|  | 121 | *	By default it is disabled, but for those that want to try it out, | 
|  | 122 | *	then set the define below to be 1. | 
|  | 123 | */ | 
|  | 124 | #define	STLI_EISAPROBE	0 | 
|  | 125 |  | 
|  | 126 | /*****************************************************************************/ | 
|  | 127 |  | 
|  | 128 | /* | 
|  | 129 | *	Define some important driver characteristics. Device major numbers | 
|  | 130 | *	allocated as per Linux Device Registry. | 
|  | 131 | */ | 
|  | 132 | #ifndef	STL_SIOMEMMAJOR | 
|  | 133 | #define	STL_SIOMEMMAJOR		28 | 
|  | 134 | #endif | 
|  | 135 | #ifndef	STL_SERIALMAJOR | 
|  | 136 | #define	STL_SERIALMAJOR		24 | 
|  | 137 | #endif | 
|  | 138 | #ifndef	STL_CALLOUTMAJOR | 
|  | 139 | #define	STL_CALLOUTMAJOR	25 | 
|  | 140 | #endif | 
|  | 141 |  | 
|  | 142 | /*****************************************************************************/ | 
|  | 143 |  | 
|  | 144 | /* | 
|  | 145 | *	Define our local driver identity first. Set up stuff to deal with | 
|  | 146 | *	all the local structures required by a serial tty driver. | 
|  | 147 | */ | 
|  | 148 | static char	*stli_drvtitle = "Stallion Intelligent Multiport Serial Driver"; | 
|  | 149 | static char	*stli_drvname = "istallion"; | 
|  | 150 | static char	*stli_drvversion = "5.6.0"; | 
|  | 151 | static char	*stli_serialname = "ttyE"; | 
|  | 152 |  | 
|  | 153 | static struct tty_driver	*stli_serial; | 
|  | 154 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 155 |  | 
|  | 156 | #define	STLI_TXBUFSIZE		4096 | 
|  | 157 |  | 
|  | 158 | /* | 
|  | 159 | *	Use a fast local buffer for cooked characters. Typically a whole | 
|  | 160 | *	bunch of cooked characters come in for a port, 1 at a time. So we | 
|  | 161 | *	save those up into a local buffer, then write out the whole lot | 
|  | 162 | *	with a large memcpy. Just use 1 buffer for all ports, since its | 
|  | 163 | *	use it is only need for short periods of time by each port. | 
|  | 164 | */ | 
|  | 165 | static char			*stli_txcookbuf; | 
|  | 166 | static int			stli_txcooksize; | 
|  | 167 | static int			stli_txcookrealsize; | 
|  | 168 | static struct tty_struct	*stli_txcooktty; | 
|  | 169 |  | 
|  | 170 | /* | 
|  | 171 | *	Define a local default termios struct. All ports will be created | 
|  | 172 | *	with this termios initially. Basically all it defines is a raw port | 
|  | 173 | *	at 9600 baud, 8 data bits, no parity, 1 stop bit. | 
|  | 174 | */ | 
| Alan Cox | 606d099 | 2006-12-08 02:38:45 -0800 | [diff] [blame] | 175 | static struct ktermios		stli_deftermios = { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 176 | .c_cflag	= (B9600 | CS8 | CREAD | HUPCL | CLOCAL), | 
|  | 177 | .c_cc		= INIT_C_CC, | 
| Alan Cox | 606d099 | 2006-12-08 02:38:45 -0800 | [diff] [blame] | 178 | .c_ispeed	= 9600, | 
|  | 179 | .c_ospeed	= 9600, | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 180 | }; | 
|  | 181 |  | 
|  | 182 | /* | 
|  | 183 | *	Define global stats structures. Not used often, and can be | 
|  | 184 | *	re-used for each stats call. | 
|  | 185 | */ | 
|  | 186 | static comstats_t	stli_comstats; | 
|  | 187 | static combrd_t		stli_brdstats; | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 188 | static struct asystats	stli_cdkstats; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 189 |  | 
|  | 190 | /*****************************************************************************/ | 
|  | 191 |  | 
| Jiri Slaby | b103b5c | 2006-12-08 02:39:21 -0800 | [diff] [blame] | 192 | static DEFINE_MUTEX(stli_brdslock); | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 193 | static struct stlibrd	*stli_brds[STL_MAXBRDS]; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 194 |  | 
|  | 195 | static int		stli_shared; | 
|  | 196 |  | 
|  | 197 | /* | 
|  | 198 | *	Per board state flags. Used with the state field of the board struct. | 
|  | 199 | *	Not really much here... All we need to do is keep track of whether | 
|  | 200 | *	the board has been detected, and whether it is actually running a slave | 
|  | 201 | *	or not. | 
|  | 202 | */ | 
|  | 203 | #define	BST_FOUND	0x1 | 
|  | 204 | #define	BST_STARTED	0x2 | 
| Jiri Slaby | 3901417 | 2006-12-08 02:39:22 -0800 | [diff] [blame] | 205 | #define	BST_PROBED	0x4 | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 206 |  | 
|  | 207 | /* | 
|  | 208 | *	Define the set of port state flags. These are marked for internal | 
|  | 209 | *	state purposes only, usually to do with the state of communications | 
|  | 210 | *	with the slave. Most of them need to be updated atomically, so always | 
|  | 211 | *	use the bit setting operations (unless protected by cli/sti). | 
|  | 212 | */ | 
|  | 213 | #define	ST_INITIALIZING	1 | 
|  | 214 | #define	ST_OPENING	2 | 
|  | 215 | #define	ST_CLOSING	3 | 
|  | 216 | #define	ST_CMDING	4 | 
|  | 217 | #define	ST_TXBUSY	5 | 
|  | 218 | #define	ST_RXING	6 | 
|  | 219 | #define	ST_DOFLUSHRX	7 | 
|  | 220 | #define	ST_DOFLUSHTX	8 | 
|  | 221 | #define	ST_DOSIGS	9 | 
|  | 222 | #define	ST_RXSTOP	10 | 
|  | 223 | #define	ST_GETSIGS	11 | 
|  | 224 |  | 
|  | 225 | /* | 
|  | 226 | *	Define an array of board names as printable strings. Handy for | 
|  | 227 | *	referencing boards when printing trace and stuff. | 
|  | 228 | */ | 
|  | 229 | static char	*stli_brdnames[] = { | 
|  | 230 | "Unknown", | 
|  | 231 | "Stallion", | 
|  | 232 | "Brumby", | 
|  | 233 | "ONboard-MC", | 
|  | 234 | "ONboard", | 
|  | 235 | "Brumby", | 
|  | 236 | "Brumby", | 
|  | 237 | "ONboard-EI", | 
| Jiri Slaby | a3f8d9d | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 238 | NULL, | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 239 | "ONboard", | 
|  | 240 | "ONboard-MC", | 
|  | 241 | "ONboard-MC", | 
| Jiri Slaby | a3f8d9d | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 242 | NULL, | 
|  | 243 | NULL, | 
|  | 244 | NULL, | 
|  | 245 | NULL, | 
|  | 246 | NULL, | 
|  | 247 | NULL, | 
|  | 248 | NULL, | 
|  | 249 | NULL, | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 250 | "EasyIO", | 
|  | 251 | "EC8/32-AT", | 
|  | 252 | "EC8/32-MC", | 
|  | 253 | "EC8/64-AT", | 
|  | 254 | "EC8/64-EI", | 
|  | 255 | "EC8/64-MC", | 
|  | 256 | "EC8/32-PCI", | 
|  | 257 | "EC8/64-PCI", | 
|  | 258 | "EasyIO-PCI", | 
|  | 259 | "EC/RA-PCI", | 
|  | 260 | }; | 
|  | 261 |  | 
|  | 262 | /*****************************************************************************/ | 
|  | 263 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 264 | /* | 
|  | 265 | *	Define some string labels for arguments passed from the module | 
|  | 266 | *	load line. These allow for easy board definitions, and easy | 
|  | 267 | *	modification of the io, memory and irq resoucres. | 
|  | 268 | */ | 
|  | 269 |  | 
|  | 270 | static char	*board0[8]; | 
|  | 271 | static char	*board1[8]; | 
|  | 272 | static char	*board2[8]; | 
|  | 273 | static char	*board3[8]; | 
|  | 274 |  | 
|  | 275 | static char	**stli_brdsp[] = { | 
|  | 276 | (char **) &board0, | 
|  | 277 | (char **) &board1, | 
|  | 278 | (char **) &board2, | 
|  | 279 | (char **) &board3 | 
|  | 280 | }; | 
|  | 281 |  | 
|  | 282 | /* | 
|  | 283 | *	Define a set of common board names, and types. This is used to | 
|  | 284 | *	parse any module arguments. | 
|  | 285 | */ | 
|  | 286 |  | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 287 | static struct stlibrdtype { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 288 | char	*name; | 
|  | 289 | int	type; | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 290 | } stli_brdstr[] = { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 291 | { "stallion", BRD_STALLION }, | 
|  | 292 | { "1", BRD_STALLION }, | 
|  | 293 | { "brumby", BRD_BRUMBY }, | 
|  | 294 | { "brumby4", BRD_BRUMBY }, | 
|  | 295 | { "brumby/4", BRD_BRUMBY }, | 
|  | 296 | { "brumby-4", BRD_BRUMBY }, | 
|  | 297 | { "brumby8", BRD_BRUMBY }, | 
|  | 298 | { "brumby/8", BRD_BRUMBY }, | 
|  | 299 | { "brumby-8", BRD_BRUMBY }, | 
|  | 300 | { "brumby16", BRD_BRUMBY }, | 
|  | 301 | { "brumby/16", BRD_BRUMBY }, | 
|  | 302 | { "brumby-16", BRD_BRUMBY }, | 
|  | 303 | { "2", BRD_BRUMBY }, | 
|  | 304 | { "onboard2", BRD_ONBOARD2 }, | 
|  | 305 | { "onboard-2", BRD_ONBOARD2 }, | 
|  | 306 | { "onboard/2", BRD_ONBOARD2 }, | 
|  | 307 | { "onboard-mc", BRD_ONBOARD2 }, | 
|  | 308 | { "onboard/mc", BRD_ONBOARD2 }, | 
|  | 309 | { "onboard-mca", BRD_ONBOARD2 }, | 
|  | 310 | { "onboard/mca", BRD_ONBOARD2 }, | 
|  | 311 | { "3", BRD_ONBOARD2 }, | 
|  | 312 | { "onboard", BRD_ONBOARD }, | 
|  | 313 | { "onboardat", BRD_ONBOARD }, | 
|  | 314 | { "4", BRD_ONBOARD }, | 
|  | 315 | { "onboarde", BRD_ONBOARDE }, | 
|  | 316 | { "onboard-e", BRD_ONBOARDE }, | 
|  | 317 | { "onboard/e", BRD_ONBOARDE }, | 
|  | 318 | { "onboard-ei", BRD_ONBOARDE }, | 
|  | 319 | { "onboard/ei", BRD_ONBOARDE }, | 
|  | 320 | { "7", BRD_ONBOARDE }, | 
|  | 321 | { "ecp", BRD_ECP }, | 
|  | 322 | { "ecpat", BRD_ECP }, | 
|  | 323 | { "ec8/64", BRD_ECP }, | 
|  | 324 | { "ec8/64-at", BRD_ECP }, | 
|  | 325 | { "ec8/64-isa", BRD_ECP }, | 
|  | 326 | { "23", BRD_ECP }, | 
|  | 327 | { "ecpe", BRD_ECPE }, | 
|  | 328 | { "ecpei", BRD_ECPE }, | 
|  | 329 | { "ec8/64-e", BRD_ECPE }, | 
|  | 330 | { "ec8/64-ei", BRD_ECPE }, | 
|  | 331 | { "24", BRD_ECPE }, | 
|  | 332 | { "ecpmc", BRD_ECPMC }, | 
|  | 333 | { "ec8/64-mc", BRD_ECPMC }, | 
|  | 334 | { "ec8/64-mca", BRD_ECPMC }, | 
|  | 335 | { "25", BRD_ECPMC }, | 
|  | 336 | { "ecppci", BRD_ECPPCI }, | 
|  | 337 | { "ec/ra", BRD_ECPPCI }, | 
|  | 338 | { "ec/ra-pc", BRD_ECPPCI }, | 
|  | 339 | { "ec/ra-pci", BRD_ECPPCI }, | 
|  | 340 | { "29", BRD_ECPPCI }, | 
|  | 341 | }; | 
|  | 342 |  | 
|  | 343 | /* | 
|  | 344 | *	Define the module agruments. | 
|  | 345 | */ | 
|  | 346 | MODULE_AUTHOR("Greg Ungerer"); | 
|  | 347 | MODULE_DESCRIPTION("Stallion Intelligent Multiport Serial Driver"); | 
|  | 348 | MODULE_LICENSE("GPL"); | 
|  | 349 |  | 
|  | 350 |  | 
| Rusty Russell | 8d3b33f | 2006-03-25 03:07:05 -0800 | [diff] [blame] | 351 | module_param_array(board0, charp, NULL, 0); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 352 | MODULE_PARM_DESC(board0, "Board 0 config -> name[,ioaddr[,memaddr]"); | 
| Rusty Russell | 8d3b33f | 2006-03-25 03:07:05 -0800 | [diff] [blame] | 353 | module_param_array(board1, charp, NULL, 0); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 354 | MODULE_PARM_DESC(board1, "Board 1 config -> name[,ioaddr[,memaddr]"); | 
| Rusty Russell | 8d3b33f | 2006-03-25 03:07:05 -0800 | [diff] [blame] | 355 | module_param_array(board2, charp, NULL, 0); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 356 | MODULE_PARM_DESC(board2, "Board 2 config -> name[,ioaddr[,memaddr]"); | 
| Rusty Russell | 8d3b33f | 2006-03-25 03:07:05 -0800 | [diff] [blame] | 357 | module_param_array(board3, charp, NULL, 0); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 358 | MODULE_PARM_DESC(board3, "Board 3 config -> name[,ioaddr[,memaddr]"); | 
|  | 359 |  | 
| Jiri Slaby | a00f33f | 2006-12-08 02:39:20 -0800 | [diff] [blame] | 360 | #if STLI_EISAPROBE != 0 | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 361 | /* | 
|  | 362 | *	Set up a default memory address table for EISA board probing. | 
|  | 363 | *	The default addresses are all bellow 1Mbyte, which has to be the | 
|  | 364 | *	case anyway. They should be safe, since we only read values from | 
|  | 365 | *	them, and interrupts are disabled while we do it. If the higher | 
|  | 366 | *	memory support is compiled in then we also try probing around | 
|  | 367 | *	the 1Gb, 2Gb and 3Gb areas as well... | 
|  | 368 | */ | 
|  | 369 | static unsigned long	stli_eisamemprobeaddrs[] = { | 
|  | 370 | 0xc0000,    0xd0000,    0xe0000,    0xf0000, | 
|  | 371 | 0x80000000, 0x80010000, 0x80020000, 0x80030000, | 
|  | 372 | 0x40000000, 0x40010000, 0x40020000, 0x40030000, | 
|  | 373 | 0xc0000000, 0xc0010000, 0xc0020000, 0xc0030000, | 
|  | 374 | 0xff000000, 0xff010000, 0xff020000, 0xff030000, | 
|  | 375 | }; | 
|  | 376 |  | 
| Tobias Klauser | fe97107 | 2006-01-09 20:54:02 -0800 | [diff] [blame] | 377 | static int	stli_eisamempsize = ARRAY_SIZE(stli_eisamemprobeaddrs); | 
| Jiri Slaby | a00f33f | 2006-12-08 02:39:20 -0800 | [diff] [blame] | 378 | #endif | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 379 |  | 
|  | 380 | /* | 
|  | 381 | *	Define the Stallion PCI vendor and device IDs. | 
|  | 382 | */ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 383 | #ifndef PCI_DEVICE_ID_ECRA | 
|  | 384 | #define	PCI_DEVICE_ID_ECRA		0x0004 | 
|  | 385 | #endif | 
|  | 386 |  | 
|  | 387 | static struct pci_device_id istallion_pci_tbl[] = { | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 388 | { PCI_DEVICE(PCI_VENDOR_ID_STALLION, PCI_DEVICE_ID_ECRA), }, | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 389 | { 0 } | 
|  | 390 | }; | 
|  | 391 | MODULE_DEVICE_TABLE(pci, istallion_pci_tbl); | 
|  | 392 |  | 
| Jiri Slaby | 845bead | 2006-12-08 02:39:17 -0800 | [diff] [blame] | 393 | static struct pci_driver stli_pcidriver; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 394 |  | 
|  | 395 | /*****************************************************************************/ | 
|  | 396 |  | 
|  | 397 | /* | 
|  | 398 | *	Hardware configuration info for ECP boards. These defines apply | 
|  | 399 | *	to the directly accessible io ports of the ECP. There is a set of | 
|  | 400 | *	defines for each ECP board type, ISA, EISA, MCA and PCI. | 
|  | 401 | */ | 
|  | 402 | #define	ECP_IOSIZE	4 | 
|  | 403 |  | 
|  | 404 | #define	ECP_MEMSIZE	(128 * 1024) | 
|  | 405 | #define	ECP_PCIMEMSIZE	(256 * 1024) | 
|  | 406 |  | 
|  | 407 | #define	ECP_ATPAGESIZE	(4 * 1024) | 
|  | 408 | #define	ECP_MCPAGESIZE	(4 * 1024) | 
|  | 409 | #define	ECP_EIPAGESIZE	(64 * 1024) | 
|  | 410 | #define	ECP_PCIPAGESIZE	(64 * 1024) | 
|  | 411 |  | 
|  | 412 | #define	STL_EISAID	0x8c4e | 
|  | 413 |  | 
|  | 414 | /* | 
|  | 415 | *	Important defines for the ISA class of ECP board. | 
|  | 416 | */ | 
|  | 417 | #define	ECP_ATIREG	0 | 
|  | 418 | #define	ECP_ATCONFR	1 | 
|  | 419 | #define	ECP_ATMEMAR	2 | 
|  | 420 | #define	ECP_ATMEMPR	3 | 
|  | 421 | #define	ECP_ATSTOP	0x1 | 
|  | 422 | #define	ECP_ATINTENAB	0x10 | 
|  | 423 | #define	ECP_ATENABLE	0x20 | 
|  | 424 | #define	ECP_ATDISABLE	0x00 | 
|  | 425 | #define	ECP_ATADDRMASK	0x3f000 | 
|  | 426 | #define	ECP_ATADDRSHFT	12 | 
|  | 427 |  | 
|  | 428 | /* | 
|  | 429 | *	Important defines for the EISA class of ECP board. | 
|  | 430 | */ | 
|  | 431 | #define	ECP_EIIREG	0 | 
|  | 432 | #define	ECP_EIMEMARL	1 | 
|  | 433 | #define	ECP_EICONFR	2 | 
|  | 434 | #define	ECP_EIMEMARH	3 | 
|  | 435 | #define	ECP_EIENABLE	0x1 | 
|  | 436 | #define	ECP_EIDISABLE	0x0 | 
|  | 437 | #define	ECP_EISTOP	0x4 | 
|  | 438 | #define	ECP_EIEDGE	0x00 | 
|  | 439 | #define	ECP_EILEVEL	0x80 | 
|  | 440 | #define	ECP_EIADDRMASKL	0x00ff0000 | 
|  | 441 | #define	ECP_EIADDRSHFTL	16 | 
|  | 442 | #define	ECP_EIADDRMASKH	0xff000000 | 
|  | 443 | #define	ECP_EIADDRSHFTH	24 | 
|  | 444 | #define	ECP_EIBRDENAB	0xc84 | 
|  | 445 |  | 
|  | 446 | #define	ECP_EISAID	0x4 | 
|  | 447 |  | 
|  | 448 | /* | 
|  | 449 | *	Important defines for the Micro-channel class of ECP board. | 
|  | 450 | *	(It has a lot in common with the ISA boards.) | 
|  | 451 | */ | 
|  | 452 | #define	ECP_MCIREG	0 | 
|  | 453 | #define	ECP_MCCONFR	1 | 
|  | 454 | #define	ECP_MCSTOP	0x20 | 
|  | 455 | #define	ECP_MCENABLE	0x80 | 
|  | 456 | #define	ECP_MCDISABLE	0x00 | 
|  | 457 |  | 
|  | 458 | /* | 
|  | 459 | *	Important defines for the PCI class of ECP board. | 
|  | 460 | *	(It has a lot in common with the other ECP boards.) | 
|  | 461 | */ | 
|  | 462 | #define	ECP_PCIIREG	0 | 
|  | 463 | #define	ECP_PCICONFR	1 | 
|  | 464 | #define	ECP_PCISTOP	0x01 | 
|  | 465 |  | 
|  | 466 | /* | 
|  | 467 | *	Hardware configuration info for ONboard and Brumby boards. These | 
|  | 468 | *	defines apply to the directly accessible io ports of these boards. | 
|  | 469 | */ | 
|  | 470 | #define	ONB_IOSIZE	16 | 
|  | 471 | #define	ONB_MEMSIZE	(64 * 1024) | 
|  | 472 | #define	ONB_ATPAGESIZE	(64 * 1024) | 
|  | 473 | #define	ONB_MCPAGESIZE	(64 * 1024) | 
|  | 474 | #define	ONB_EIMEMSIZE	(128 * 1024) | 
|  | 475 | #define	ONB_EIPAGESIZE	(64 * 1024) | 
|  | 476 |  | 
|  | 477 | /* | 
|  | 478 | *	Important defines for the ISA class of ONboard board. | 
|  | 479 | */ | 
|  | 480 | #define	ONB_ATIREG	0 | 
|  | 481 | #define	ONB_ATMEMAR	1 | 
|  | 482 | #define	ONB_ATCONFR	2 | 
|  | 483 | #define	ONB_ATSTOP	0x4 | 
|  | 484 | #define	ONB_ATENABLE	0x01 | 
|  | 485 | #define	ONB_ATDISABLE	0x00 | 
|  | 486 | #define	ONB_ATADDRMASK	0xff0000 | 
|  | 487 | #define	ONB_ATADDRSHFT	16 | 
|  | 488 |  | 
|  | 489 | #define	ONB_MEMENABLO	0 | 
|  | 490 | #define	ONB_MEMENABHI	0x02 | 
|  | 491 |  | 
|  | 492 | /* | 
|  | 493 | *	Important defines for the EISA class of ONboard board. | 
|  | 494 | */ | 
|  | 495 | #define	ONB_EIIREG	0 | 
|  | 496 | #define	ONB_EIMEMARL	1 | 
|  | 497 | #define	ONB_EICONFR	2 | 
|  | 498 | #define	ONB_EIMEMARH	3 | 
|  | 499 | #define	ONB_EIENABLE	0x1 | 
|  | 500 | #define	ONB_EIDISABLE	0x0 | 
|  | 501 | #define	ONB_EISTOP	0x4 | 
|  | 502 | #define	ONB_EIEDGE	0x00 | 
|  | 503 | #define	ONB_EILEVEL	0x80 | 
|  | 504 | #define	ONB_EIADDRMASKL	0x00ff0000 | 
|  | 505 | #define	ONB_EIADDRSHFTL	16 | 
|  | 506 | #define	ONB_EIADDRMASKH	0xff000000 | 
|  | 507 | #define	ONB_EIADDRSHFTH	24 | 
|  | 508 | #define	ONB_EIBRDENAB	0xc84 | 
|  | 509 |  | 
|  | 510 | #define	ONB_EISAID	0x1 | 
|  | 511 |  | 
|  | 512 | /* | 
|  | 513 | *	Important defines for the Brumby boards. They are pretty simple, | 
|  | 514 | *	there is not much that is programmably configurable. | 
|  | 515 | */ | 
|  | 516 | #define	BBY_IOSIZE	16 | 
|  | 517 | #define	BBY_MEMSIZE	(64 * 1024) | 
|  | 518 | #define	BBY_PAGESIZE	(16 * 1024) | 
|  | 519 |  | 
|  | 520 | #define	BBY_ATIREG	0 | 
|  | 521 | #define	BBY_ATCONFR	1 | 
|  | 522 | #define	BBY_ATSTOP	0x4 | 
|  | 523 |  | 
|  | 524 | /* | 
|  | 525 | *	Important defines for the Stallion boards. They are pretty simple, | 
|  | 526 | *	there is not much that is programmably configurable. | 
|  | 527 | */ | 
|  | 528 | #define	STAL_IOSIZE	16 | 
|  | 529 | #define	STAL_MEMSIZE	(64 * 1024) | 
|  | 530 | #define	STAL_PAGESIZE	(64 * 1024) | 
|  | 531 |  | 
|  | 532 | /* | 
|  | 533 | *	Define the set of status register values for EasyConnection panels. | 
|  | 534 | *	The signature will return with the status value for each panel. From | 
|  | 535 | *	this we can determine what is attached to the board - before we have | 
|  | 536 | *	actually down loaded any code to it. | 
|  | 537 | */ | 
|  | 538 | #define	ECH_PNLSTATUS	2 | 
|  | 539 | #define	ECH_PNL16PORT	0x20 | 
|  | 540 | #define	ECH_PNLIDMASK	0x07 | 
|  | 541 | #define	ECH_PNLXPID	0x40 | 
|  | 542 | #define	ECH_PNLINTRPEND	0x80 | 
|  | 543 |  | 
|  | 544 | /* | 
|  | 545 | *	Define some macros to do things to the board. Even those these boards | 
|  | 546 | *	are somewhat related there is often significantly different ways of | 
|  | 547 | *	doing some operation on it (like enable, paging, reset, etc). So each | 
|  | 548 | *	board class has a set of functions which do the commonly required | 
|  | 549 | *	operations. The macros below basically just call these functions, | 
|  | 550 | *	generally checking for a NULL function - which means that the board | 
|  | 551 | *	needs nothing done to it to achieve this operation! | 
|  | 552 | */ | 
|  | 553 | #define	EBRDINIT(brdp)						\ | 
|  | 554 | if (brdp->init != NULL)					\ | 
|  | 555 | (* brdp->init)(brdp) | 
|  | 556 |  | 
|  | 557 | #define	EBRDENABLE(brdp)					\ | 
|  | 558 | if (brdp->enable != NULL)				\ | 
|  | 559 | (* brdp->enable)(brdp); | 
|  | 560 |  | 
|  | 561 | #define	EBRDDISABLE(brdp)					\ | 
|  | 562 | if (brdp->disable != NULL)				\ | 
|  | 563 | (* brdp->disable)(brdp); | 
|  | 564 |  | 
|  | 565 | #define	EBRDINTR(brdp)						\ | 
|  | 566 | if (brdp->intr != NULL)					\ | 
|  | 567 | (* brdp->intr)(brdp); | 
|  | 568 |  | 
|  | 569 | #define	EBRDRESET(brdp)						\ | 
|  | 570 | if (brdp->reset != NULL)				\ | 
|  | 571 | (* brdp->reset)(brdp); | 
|  | 572 |  | 
|  | 573 | #define	EBRDGETMEMPTR(brdp,offset)				\ | 
|  | 574 | (* brdp->getmemptr)(brdp, offset, __LINE__) | 
|  | 575 |  | 
|  | 576 | /* | 
|  | 577 | *	Define the maximal baud rate, and the default baud base for ports. | 
|  | 578 | */ | 
|  | 579 | #define	STL_MAXBAUD	460800 | 
|  | 580 | #define	STL_BAUDBASE	115200 | 
|  | 581 | #define	STL_CLOSEDELAY	(5 * HZ / 10) | 
|  | 582 |  | 
|  | 583 | /*****************************************************************************/ | 
|  | 584 |  | 
|  | 585 | /* | 
|  | 586 | *	Define macros to extract a brd or port number from a minor number. | 
|  | 587 | */ | 
|  | 588 | #define	MINOR2BRD(min)		(((min) & 0xc0) >> 6) | 
|  | 589 | #define	MINOR2PORT(min)		((min) & 0x3f) | 
|  | 590 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 591 | /*****************************************************************************/ | 
|  | 592 |  | 
|  | 593 | /* | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 594 | *	Prototype all functions in this driver! | 
|  | 595 | */ | 
|  | 596 |  | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 597 | static int	stli_parsebrd(struct stlconf *confp, char **argp); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 598 | static int	stli_open(struct tty_struct *tty, struct file *filp); | 
|  | 599 | static void	stli_close(struct tty_struct *tty, struct file *filp); | 
|  | 600 | static int	stli_write(struct tty_struct *tty, const unsigned char *buf, int count); | 
|  | 601 | static void	stli_putchar(struct tty_struct *tty, unsigned char ch); | 
|  | 602 | static void	stli_flushchars(struct tty_struct *tty); | 
|  | 603 | static int	stli_writeroom(struct tty_struct *tty); | 
|  | 604 | static int	stli_charsinbuffer(struct tty_struct *tty); | 
|  | 605 | static int	stli_ioctl(struct tty_struct *tty, struct file *file, unsigned int cmd, unsigned long arg); | 
| Alan Cox | 606d099 | 2006-12-08 02:38:45 -0800 | [diff] [blame] | 606 | static void	stli_settermios(struct tty_struct *tty, struct ktermios *old); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 607 | static void	stli_throttle(struct tty_struct *tty); | 
|  | 608 | static void	stli_unthrottle(struct tty_struct *tty); | 
|  | 609 | static void	stli_stop(struct tty_struct *tty); | 
|  | 610 | static void	stli_start(struct tty_struct *tty); | 
|  | 611 | static void	stli_flushbuffer(struct tty_struct *tty); | 
|  | 612 | static void	stli_breakctl(struct tty_struct *tty, int state); | 
|  | 613 | static void	stli_waituntilsent(struct tty_struct *tty, int timeout); | 
|  | 614 | static void	stli_sendxchar(struct tty_struct *tty, char ch); | 
|  | 615 | static void	stli_hangup(struct tty_struct *tty); | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 616 | static int	stli_portinfo(struct stlibrd *brdp, struct stliport *portp, int portnr, char *pos); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 617 |  | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 618 | static int	stli_brdinit(struct stlibrd *brdp); | 
|  | 619 | static int	stli_startbrd(struct stlibrd *brdp); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 620 | static ssize_t	stli_memread(struct file *fp, char __user *buf, size_t count, loff_t *offp); | 
|  | 621 | static ssize_t	stli_memwrite(struct file *fp, const char __user *buf, size_t count, loff_t *offp); | 
|  | 622 | static int	stli_memioctl(struct inode *ip, struct file *fp, unsigned int cmd, unsigned long arg); | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 623 | static void	stli_brdpoll(struct stlibrd *brdp, cdkhdr_t __iomem *hdrp); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 624 | static void	stli_poll(unsigned long arg); | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 625 | static int	stli_hostcmd(struct stlibrd *brdp, struct stliport *portp); | 
|  | 626 | static int	stli_initopen(struct stlibrd *brdp, struct stliport *portp); | 
|  | 627 | static int	stli_rawopen(struct stlibrd *brdp, struct stliport *portp, unsigned long arg, int wait); | 
|  | 628 | static int	stli_rawclose(struct stlibrd *brdp, struct stliport *portp, unsigned long arg, int wait); | 
|  | 629 | static int	stli_waitcarrier(struct stlibrd *brdp, struct stliport *portp, struct file *filp); | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 630 | static int	stli_setport(struct stliport *portp); | 
|  | 631 | static int	stli_cmdwait(struct stlibrd *brdp, struct stliport *portp, unsigned long cmd, void *arg, int size, int copyback); | 
|  | 632 | static void	stli_sendcmd(struct stlibrd *brdp, struct stliport *portp, unsigned long cmd, void *arg, int size, int copyback); | 
|  | 633 | static void	__stli_sendcmd(struct stlibrd *brdp, struct stliport *portp, unsigned long cmd, void *arg, int size, int copyback); | 
|  | 634 | static void	stli_dodelaycmd(struct stliport *portp, cdkctrl_t __iomem *cp); | 
|  | 635 | static void	stli_mkasyport(struct stliport *portp, asyport_t *pp, struct ktermios *tiosp); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 636 | static void	stli_mkasysigs(asysigs_t *sp, int dtr, int rts); | 
|  | 637 | static long	stli_mktiocm(unsigned long sigvalue); | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 638 | static void	stli_read(struct stlibrd *brdp, struct stliport *portp); | 
|  | 639 | static int	stli_getserial(struct stliport *portp, struct serial_struct __user *sp); | 
|  | 640 | static int	stli_setserial(struct stliport *portp, struct serial_struct __user *sp); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 641 | static int	stli_getbrdstats(combrd_t __user *bp); | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 642 | static int	stli_getportstats(struct stliport *portp, comstats_t __user *cp); | 
|  | 643 | static int	stli_portcmdstats(struct stliport *portp); | 
|  | 644 | static int	stli_clrportstats(struct stliport *portp, comstats_t __user *cp); | 
|  | 645 | static int	stli_getportstruct(struct stliport __user *arg); | 
|  | 646 | static int	stli_getbrdstruct(struct stlibrd __user *arg); | 
|  | 647 | static struct stlibrd *stli_allocbrd(void); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 648 |  | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 649 | static void	stli_ecpinit(struct stlibrd *brdp); | 
|  | 650 | static void	stli_ecpenable(struct stlibrd *brdp); | 
|  | 651 | static void	stli_ecpdisable(struct stlibrd *brdp); | 
|  | 652 | static void __iomem *stli_ecpgetmemptr(struct stlibrd *brdp, unsigned long offset, int line); | 
|  | 653 | static void	stli_ecpreset(struct stlibrd *brdp); | 
|  | 654 | static void	stli_ecpintr(struct stlibrd *brdp); | 
|  | 655 | static void	stli_ecpeiinit(struct stlibrd *brdp); | 
|  | 656 | static void	stli_ecpeienable(struct stlibrd *brdp); | 
|  | 657 | static void	stli_ecpeidisable(struct stlibrd *brdp); | 
|  | 658 | static void __iomem *stli_ecpeigetmemptr(struct stlibrd *brdp, unsigned long offset, int line); | 
|  | 659 | static void	stli_ecpeireset(struct stlibrd *brdp); | 
|  | 660 | static void	stli_ecpmcenable(struct stlibrd *brdp); | 
|  | 661 | static void	stli_ecpmcdisable(struct stlibrd *brdp); | 
|  | 662 | static void __iomem *stli_ecpmcgetmemptr(struct stlibrd *brdp, unsigned long offset, int line); | 
|  | 663 | static void	stli_ecpmcreset(struct stlibrd *brdp); | 
|  | 664 | static void	stli_ecppciinit(struct stlibrd *brdp); | 
|  | 665 | static void __iomem *stli_ecppcigetmemptr(struct stlibrd *brdp, unsigned long offset, int line); | 
|  | 666 | static void	stli_ecppcireset(struct stlibrd *brdp); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 667 |  | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 668 | static void	stli_onbinit(struct stlibrd *brdp); | 
|  | 669 | static void	stli_onbenable(struct stlibrd *brdp); | 
|  | 670 | static void	stli_onbdisable(struct stlibrd *brdp); | 
|  | 671 | static void __iomem *stli_onbgetmemptr(struct stlibrd *brdp, unsigned long offset, int line); | 
|  | 672 | static void	stli_onbreset(struct stlibrd *brdp); | 
|  | 673 | static void	stli_onbeinit(struct stlibrd *brdp); | 
|  | 674 | static void	stli_onbeenable(struct stlibrd *brdp); | 
|  | 675 | static void	stli_onbedisable(struct stlibrd *brdp); | 
|  | 676 | static void __iomem *stli_onbegetmemptr(struct stlibrd *brdp, unsigned long offset, int line); | 
|  | 677 | static void	stli_onbereset(struct stlibrd *brdp); | 
|  | 678 | static void	stli_bbyinit(struct stlibrd *brdp); | 
|  | 679 | static void __iomem *stli_bbygetmemptr(struct stlibrd *brdp, unsigned long offset, int line); | 
|  | 680 | static void	stli_bbyreset(struct stlibrd *brdp); | 
|  | 681 | static void	stli_stalinit(struct stlibrd *brdp); | 
|  | 682 | static void __iomem *stli_stalgetmemptr(struct stlibrd *brdp, unsigned long offset, int line); | 
|  | 683 | static void	stli_stalreset(struct stlibrd *brdp); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 684 |  | 
| Jiri Slaby | 1328d73 | 2006-12-08 02:39:19 -0800 | [diff] [blame] | 685 | static struct stliport *stli_getport(unsigned int brdnr, unsigned int panelnr, unsigned int portnr); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 686 |  | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 687 | static int	stli_initecp(struct stlibrd *brdp); | 
|  | 688 | static int	stli_initonb(struct stlibrd *brdp); | 
| Jiri Slaby | a00f33f | 2006-12-08 02:39:20 -0800 | [diff] [blame] | 689 | #if STLI_EISAPROBE != 0 | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 690 | static int	stli_eisamemprobe(struct stlibrd *brdp); | 
| Jiri Slaby | a00f33f | 2006-12-08 02:39:20 -0800 | [diff] [blame] | 691 | #endif | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 692 | static int	stli_initports(struct stlibrd *brdp); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 693 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 694 | /*****************************************************************************/ | 
|  | 695 |  | 
|  | 696 | /* | 
|  | 697 | *	Define the driver info for a user level shared memory device. This | 
|  | 698 | *	device will work sort of like the /dev/kmem device - except that it | 
|  | 699 | *	will give access to the shared memory on the Stallion intelligent | 
|  | 700 | *	board. This is also a very useful debugging tool. | 
|  | 701 | */ | 
| Arjan van de Ven | 62322d2 | 2006-07-03 00:24:21 -0700 | [diff] [blame] | 702 | static const struct file_operations	stli_fsiomem = { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 703 | .owner		= THIS_MODULE, | 
|  | 704 | .read		= stli_memread, | 
|  | 705 | .write		= stli_memwrite, | 
|  | 706 | .ioctl		= stli_memioctl, | 
|  | 707 | }; | 
|  | 708 |  | 
|  | 709 | /*****************************************************************************/ | 
|  | 710 |  | 
|  | 711 | /* | 
|  | 712 | *	Define a timer_list entry for our poll routine. The slave board | 
|  | 713 | *	is polled every so often to see if anything needs doing. This is | 
|  | 714 | *	much cheaper on host cpu than using interrupts. It turns out to | 
|  | 715 | *	not increase character latency by much either... | 
|  | 716 | */ | 
| Ingo Molnar | 8d06afa | 2005-09-09 13:10:40 -0700 | [diff] [blame] | 717 | static DEFINE_TIMER(stli_timerlist, stli_poll, 0, 0); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 718 |  | 
|  | 719 | static int	stli_timeron; | 
|  | 720 |  | 
|  | 721 | /* | 
|  | 722 | *	Define the calculation for the timeout routine. | 
|  | 723 | */ | 
|  | 724 | #define	STLI_TIMEOUT	(jiffies + 1) | 
|  | 725 |  | 
|  | 726 | /*****************************************************************************/ | 
|  | 727 |  | 
| gregkh@suse.de | ca8eca6 | 2005-03-23 09:53:09 -0800 | [diff] [blame] | 728 | static struct class *istallion_class; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 729 |  | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 730 | static void stli_cleanup_ports(struct stlibrd *brdp) | 
| Jiri Slaby | 845bead | 2006-12-08 02:39:17 -0800 | [diff] [blame] | 731 | { | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 732 | struct stliport *portp; | 
| Jiri Slaby | 845bead | 2006-12-08 02:39:17 -0800 | [diff] [blame] | 733 | unsigned int j; | 
|  | 734 |  | 
|  | 735 | for (j = 0; j < STL_MAXPORTS; j++) { | 
|  | 736 | portp = brdp->ports[j]; | 
|  | 737 | if (portp != NULL) { | 
|  | 738 | if (portp->tty != NULL) | 
|  | 739 | tty_hangup(portp->tty); | 
|  | 740 | kfree(portp); | 
|  | 741 | } | 
|  | 742 | } | 
|  | 743 | } | 
|  | 744 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 745 | /*****************************************************************************/ | 
|  | 746 |  | 
|  | 747 | /* | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 748 | *	Parse the supplied argument string, into the board conf struct. | 
|  | 749 | */ | 
|  | 750 |  | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 751 | static int stli_parsebrd(struct stlconf *confp, char **argp) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 752 | { | 
| Jiri Slaby | 1328d73 | 2006-12-08 02:39:19 -0800 | [diff] [blame] | 753 | unsigned int i; | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 754 | char *sp; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 755 |  | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 756 | if (argp[0] == NULL || *argp[0] == 0) | 
|  | 757 | return 0; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 758 |  | 
|  | 759 | for (sp = argp[0], i = 0; ((*sp != 0) && (i < 25)); sp++, i++) | 
| Jiri Slaby | a3f8d9d | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 760 | *sp = tolower(*sp); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 761 |  | 
| Tobias Klauser | fe97107 | 2006-01-09 20:54:02 -0800 | [diff] [blame] | 762 | for (i = 0; i < ARRAY_SIZE(stli_brdstr); i++) { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 763 | if (strcmp(stli_brdstr[i].name, argp[0]) == 0) | 
|  | 764 | break; | 
|  | 765 | } | 
| Tobias Klauser | fe97107 | 2006-01-09 20:54:02 -0800 | [diff] [blame] | 766 | if (i == ARRAY_SIZE(stli_brdstr)) { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 767 | printk("STALLION: unknown board name, %s?\n", argp[0]); | 
| Tobias Klauser | fe97107 | 2006-01-09 20:54:02 -0800 | [diff] [blame] | 768 | return 0; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 769 | } | 
|  | 770 |  | 
|  | 771 | confp->brdtype = stli_brdstr[i].type; | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 772 | if (argp[1] != NULL && *argp[1] != 0) | 
| Jiri Slaby | a3f8d9d | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 773 | confp->ioaddr1 = simple_strtoul(argp[1], NULL, 0); | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 774 | if (argp[2] !=  NULL && *argp[2] != 0) | 
| Jiri Slaby | a3f8d9d | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 775 | confp->memaddr = simple_strtoul(argp[2], NULL, 0); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 776 | return(1); | 
|  | 777 | } | 
|  | 778 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 779 | /*****************************************************************************/ | 
|  | 780 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 781 | static int stli_open(struct tty_struct *tty, struct file *filp) | 
|  | 782 | { | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 783 | struct stlibrd *brdp; | 
|  | 784 | struct stliport *portp; | 
| Jiri Slaby | 1328d73 | 2006-12-08 02:39:19 -0800 | [diff] [blame] | 785 | unsigned int minordev, brdnr, portnr; | 
|  | 786 | int rc; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 787 |  | 
|  | 788 | minordev = tty->index; | 
|  | 789 | brdnr = MINOR2BRD(minordev); | 
|  | 790 | if (brdnr >= stli_nrbrds) | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 791 | return -ENODEV; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 792 | brdp = stli_brds[brdnr]; | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 793 | if (brdp == NULL) | 
|  | 794 | return -ENODEV; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 795 | if ((brdp->state & BST_STARTED) == 0) | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 796 | return -ENODEV; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 797 | portnr = MINOR2PORT(minordev); | 
| Jiri Slaby | 1328d73 | 2006-12-08 02:39:19 -0800 | [diff] [blame] | 798 | if (portnr > brdp->nrports) | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 799 | return -ENODEV; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 800 |  | 
|  | 801 | portp = brdp->ports[portnr]; | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 802 | if (portp == NULL) | 
|  | 803 | return -ENODEV; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 804 | if (portp->devnr < 1) | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 805 | return -ENODEV; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 806 |  | 
|  | 807 |  | 
|  | 808 | /* | 
|  | 809 | *	Check if this port is in the middle of closing. If so then wait | 
|  | 810 | *	until it is closed then return error status based on flag settings. | 
|  | 811 | *	The sleep here does not need interrupt protection since the wakeup | 
|  | 812 | *	for it is done with the same context. | 
|  | 813 | */ | 
|  | 814 | if (portp->flags & ASYNC_CLOSING) { | 
|  | 815 | interruptible_sleep_on(&portp->close_wait); | 
|  | 816 | if (portp->flags & ASYNC_HUP_NOTIFY) | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 817 | return -EAGAIN; | 
|  | 818 | return -ERESTARTSYS; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 819 | } | 
|  | 820 |  | 
|  | 821 | /* | 
|  | 822 | *	On the first open of the device setup the port hardware, and | 
|  | 823 | *	initialize the per port data structure. Since initializing the port | 
|  | 824 | *	requires several commands to the board we will need to wait for any | 
|  | 825 | *	other open that is already initializing the port. | 
|  | 826 | */ | 
|  | 827 | portp->tty = tty; | 
|  | 828 | tty->driver_data = portp; | 
|  | 829 | portp->refcount++; | 
|  | 830 |  | 
|  | 831 | wait_event_interruptible(portp->raw_wait, | 
|  | 832 | !test_bit(ST_INITIALIZING, &portp->state)); | 
|  | 833 | if (signal_pending(current)) | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 834 | return -ERESTARTSYS; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 835 |  | 
|  | 836 | if ((portp->flags & ASYNC_INITIALIZED) == 0) { | 
|  | 837 | set_bit(ST_INITIALIZING, &portp->state); | 
|  | 838 | if ((rc = stli_initopen(brdp, portp)) >= 0) { | 
|  | 839 | portp->flags |= ASYNC_INITIALIZED; | 
|  | 840 | clear_bit(TTY_IO_ERROR, &tty->flags); | 
|  | 841 | } | 
|  | 842 | clear_bit(ST_INITIALIZING, &portp->state); | 
|  | 843 | wake_up_interruptible(&portp->raw_wait); | 
|  | 844 | if (rc < 0) | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 845 | return rc; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 846 | } | 
|  | 847 |  | 
|  | 848 | /* | 
|  | 849 | *	Check if this port is in the middle of closing. If so then wait | 
|  | 850 | *	until it is closed then return error status, based on flag settings. | 
|  | 851 | *	The sleep here does not need interrupt protection since the wakeup | 
|  | 852 | *	for it is done with the same context. | 
|  | 853 | */ | 
|  | 854 | if (portp->flags & ASYNC_CLOSING) { | 
|  | 855 | interruptible_sleep_on(&portp->close_wait); | 
|  | 856 | if (portp->flags & ASYNC_HUP_NOTIFY) | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 857 | return -EAGAIN; | 
|  | 858 | return -ERESTARTSYS; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 859 | } | 
|  | 860 |  | 
|  | 861 | /* | 
|  | 862 | *	Based on type of open being done check if it can overlap with any | 
|  | 863 | *	previous opens still in effect. If we are a normal serial device | 
|  | 864 | *	then also we might have to wait for carrier. | 
|  | 865 | */ | 
|  | 866 | if (!(filp->f_flags & O_NONBLOCK)) { | 
|  | 867 | if ((rc = stli_waitcarrier(brdp, portp, filp)) != 0) | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 868 | return rc; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 869 | } | 
|  | 870 | portp->flags |= ASYNC_NORMAL_ACTIVE; | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 871 | return 0; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 872 | } | 
|  | 873 |  | 
|  | 874 | /*****************************************************************************/ | 
|  | 875 |  | 
|  | 876 | static void stli_close(struct tty_struct *tty, struct file *filp) | 
|  | 877 | { | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 878 | struct stlibrd *brdp; | 
|  | 879 | struct stliport *portp; | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 880 | unsigned long flags; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 881 |  | 
|  | 882 | portp = tty->driver_data; | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 883 | if (portp == NULL) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 884 | return; | 
|  | 885 |  | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 886 | spin_lock_irqsave(&stli_lock, flags); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 887 | if (tty_hung_up_p(filp)) { | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 888 | spin_unlock_irqrestore(&stli_lock, flags); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 889 | return; | 
|  | 890 | } | 
|  | 891 | if ((tty->count == 1) && (portp->refcount != 1)) | 
|  | 892 | portp->refcount = 1; | 
|  | 893 | if (portp->refcount-- > 1) { | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 894 | spin_unlock_irqrestore(&stli_lock, flags); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 895 | return; | 
|  | 896 | } | 
|  | 897 |  | 
|  | 898 | portp->flags |= ASYNC_CLOSING; | 
|  | 899 |  | 
|  | 900 | /* | 
|  | 901 | *	May want to wait for data to drain before closing. The BUSY flag | 
|  | 902 | *	keeps track of whether we are still transmitting or not. It is | 
|  | 903 | *	updated by messages from the slave - indicating when all chars | 
|  | 904 | *	really have drained. | 
|  | 905 | */ | 
|  | 906 | if (tty == stli_txcooktty) | 
|  | 907 | stli_flushchars(tty); | 
|  | 908 | tty->closing = 1; | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 909 | spin_unlock_irqrestore(&stli_lock, flags); | 
|  | 910 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 911 | if (portp->closing_wait != ASYNC_CLOSING_WAIT_NONE) | 
|  | 912 | tty_wait_until_sent(tty, portp->closing_wait); | 
|  | 913 |  | 
|  | 914 | portp->flags &= ~ASYNC_INITIALIZED; | 
|  | 915 | brdp = stli_brds[portp->brdnr]; | 
|  | 916 | stli_rawclose(brdp, portp, 0, 0); | 
|  | 917 | if (tty->termios->c_cflag & HUPCL) { | 
|  | 918 | stli_mkasysigs(&portp->asig, 0, 0); | 
|  | 919 | if (test_bit(ST_CMDING, &portp->state)) | 
|  | 920 | set_bit(ST_DOSIGS, &portp->state); | 
|  | 921 | else | 
|  | 922 | stli_sendcmd(brdp, portp, A_SETSIGNALS, &portp->asig, | 
|  | 923 | sizeof(asysigs_t), 0); | 
|  | 924 | } | 
|  | 925 | clear_bit(ST_TXBUSY, &portp->state); | 
|  | 926 | clear_bit(ST_RXSTOP, &portp->state); | 
|  | 927 | set_bit(TTY_IO_ERROR, &tty->flags); | 
|  | 928 | if (tty->ldisc.flush_buffer) | 
|  | 929 | (tty->ldisc.flush_buffer)(tty); | 
|  | 930 | set_bit(ST_DOFLUSHRX, &portp->state); | 
|  | 931 | stli_flushbuffer(tty); | 
|  | 932 |  | 
|  | 933 | tty->closing = 0; | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 934 | portp->tty = NULL; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 935 |  | 
|  | 936 | if (portp->openwaitcnt) { | 
|  | 937 | if (portp->close_delay) | 
|  | 938 | msleep_interruptible(jiffies_to_msecs(portp->close_delay)); | 
|  | 939 | wake_up_interruptible(&portp->open_wait); | 
|  | 940 | } | 
|  | 941 |  | 
|  | 942 | portp->flags &= ~(ASYNC_NORMAL_ACTIVE|ASYNC_CLOSING); | 
|  | 943 | wake_up_interruptible(&portp->close_wait); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 944 | } | 
|  | 945 |  | 
|  | 946 | /*****************************************************************************/ | 
|  | 947 |  | 
|  | 948 | /* | 
|  | 949 | *	Carry out first open operations on a port. This involves a number of | 
|  | 950 | *	commands to be sent to the slave. We need to open the port, set the | 
|  | 951 | *	notification events, set the initial port settings, get and set the | 
|  | 952 | *	initial signal values. We sleep and wait in between each one. But | 
|  | 953 | *	this still all happens pretty quickly. | 
|  | 954 | */ | 
|  | 955 |  | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 956 | static int stli_initopen(struct stlibrd *brdp, struct stliport *portp) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 957 | { | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 958 | struct tty_struct *tty; | 
|  | 959 | asynotify_t nt; | 
|  | 960 | asyport_t aport; | 
|  | 961 | int rc; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 962 |  | 
|  | 963 | if ((rc = stli_rawopen(brdp, portp, 0, 1)) < 0) | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 964 | return rc; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 965 |  | 
|  | 966 | memset(&nt, 0, sizeof(asynotify_t)); | 
|  | 967 | nt.data = (DT_TXLOW | DT_TXEMPTY | DT_RXBUSY | DT_RXBREAK); | 
|  | 968 | nt.signal = SG_DCD; | 
|  | 969 | if ((rc = stli_cmdwait(brdp, portp, A_SETNOTIFY, &nt, | 
|  | 970 | sizeof(asynotify_t), 0)) < 0) | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 971 | return rc; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 972 |  | 
|  | 973 | tty = portp->tty; | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 974 | if (tty == NULL) | 
|  | 975 | return -ENODEV; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 976 | stli_mkasyport(portp, &aport, tty->termios); | 
|  | 977 | if ((rc = stli_cmdwait(brdp, portp, A_SETPORT, &aport, | 
|  | 978 | sizeof(asyport_t), 0)) < 0) | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 979 | return rc; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 980 |  | 
|  | 981 | set_bit(ST_GETSIGS, &portp->state); | 
|  | 982 | if ((rc = stli_cmdwait(brdp, portp, A_GETSIGNALS, &portp->asig, | 
|  | 983 | sizeof(asysigs_t), 1)) < 0) | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 984 | return rc; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 985 | if (test_and_clear_bit(ST_GETSIGS, &portp->state)) | 
|  | 986 | portp->sigs = stli_mktiocm(portp->asig.sigvalue); | 
|  | 987 | stli_mkasysigs(&portp->asig, 1, 1); | 
|  | 988 | if ((rc = stli_cmdwait(brdp, portp, A_SETSIGNALS, &portp->asig, | 
|  | 989 | sizeof(asysigs_t), 0)) < 0) | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 990 | return rc; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 991 |  | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 992 | return 0; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 993 | } | 
|  | 994 |  | 
|  | 995 | /*****************************************************************************/ | 
|  | 996 |  | 
|  | 997 | /* | 
|  | 998 | *	Send an open message to the slave. This will sleep waiting for the | 
|  | 999 | *	acknowledgement, so must have user context. We need to co-ordinate | 
|  | 1000 | *	with close events here, since we don't want open and close events | 
|  | 1001 | *	to overlap. | 
|  | 1002 | */ | 
|  | 1003 |  | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 1004 | static int stli_rawopen(struct stlibrd *brdp, struct stliport *portp, unsigned long arg, int wait) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1005 | { | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1006 | cdkhdr_t __iomem *hdrp; | 
|  | 1007 | cdkctrl_t __iomem *cp; | 
|  | 1008 | unsigned char __iomem *bits; | 
|  | 1009 | unsigned long flags; | 
|  | 1010 | int rc; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1011 |  | 
|  | 1012 | /* | 
|  | 1013 | *	Send a message to the slave to open this port. | 
|  | 1014 | */ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1015 |  | 
|  | 1016 | /* | 
|  | 1017 | *	Slave is already closing this port. This can happen if a hangup | 
|  | 1018 | *	occurs on this port. So we must wait until it is complete. The | 
|  | 1019 | *	order of opens and closes may not be preserved across shared | 
|  | 1020 | *	memory, so we must wait until it is complete. | 
|  | 1021 | */ | 
|  | 1022 | wait_event_interruptible(portp->raw_wait, | 
|  | 1023 | !test_bit(ST_CLOSING, &portp->state)); | 
|  | 1024 | if (signal_pending(current)) { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1025 | return -ERESTARTSYS; | 
|  | 1026 | } | 
|  | 1027 |  | 
|  | 1028 | /* | 
|  | 1029 | *	Everything is ready now, so write the open message into shared | 
|  | 1030 | *	memory. Once the message is in set the service bits to say that | 
|  | 1031 | *	this port wants service. | 
|  | 1032 | */ | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1033 | spin_lock_irqsave(&brd_lock, flags); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1034 | EBRDENABLE(brdp); | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1035 | cp = &((cdkasy_t __iomem *) EBRDGETMEMPTR(brdp, portp->addr))->ctrl; | 
|  | 1036 | writel(arg, &cp->openarg); | 
|  | 1037 | writeb(1, &cp->open); | 
|  | 1038 | hdrp = (cdkhdr_t __iomem *) EBRDGETMEMPTR(brdp, CDK_CDKADDR); | 
|  | 1039 | bits = ((unsigned char __iomem *) hdrp) + brdp->slaveoffset + | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1040 | portp->portidx; | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1041 | writeb(readb(bits) | portp->portbit, bits); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1042 | EBRDDISABLE(brdp); | 
|  | 1043 |  | 
|  | 1044 | if (wait == 0) { | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1045 | spin_unlock_irqrestore(&brd_lock, flags); | 
|  | 1046 | return 0; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1047 | } | 
|  | 1048 |  | 
|  | 1049 | /* | 
|  | 1050 | *	Slave is in action, so now we must wait for the open acknowledgment | 
|  | 1051 | *	to come back. | 
|  | 1052 | */ | 
|  | 1053 | rc = 0; | 
|  | 1054 | set_bit(ST_OPENING, &portp->state); | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1055 | spin_unlock_irqrestore(&brd_lock, flags); | 
|  | 1056 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1057 | wait_event_interruptible(portp->raw_wait, | 
|  | 1058 | !test_bit(ST_OPENING, &portp->state)); | 
|  | 1059 | if (signal_pending(current)) | 
|  | 1060 | rc = -ERESTARTSYS; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1061 |  | 
|  | 1062 | if ((rc == 0) && (portp->rc != 0)) | 
|  | 1063 | rc = -EIO; | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1064 | return rc; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1065 | } | 
|  | 1066 |  | 
|  | 1067 | /*****************************************************************************/ | 
|  | 1068 |  | 
|  | 1069 | /* | 
|  | 1070 | *	Send a close message to the slave. Normally this will sleep waiting | 
|  | 1071 | *	for the acknowledgement, but if wait parameter is 0 it will not. If | 
|  | 1072 | *	wait is true then must have user context (to sleep). | 
|  | 1073 | */ | 
|  | 1074 |  | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 1075 | static int stli_rawclose(struct stlibrd *brdp, struct stliport *portp, unsigned long arg, int wait) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1076 | { | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1077 | cdkhdr_t __iomem *hdrp; | 
|  | 1078 | cdkctrl_t __iomem *cp; | 
|  | 1079 | unsigned char __iomem *bits; | 
|  | 1080 | unsigned long flags; | 
|  | 1081 | int rc; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1082 |  | 
|  | 1083 | /* | 
|  | 1084 | *	Slave is already closing this port. This can happen if a hangup | 
|  | 1085 | *	occurs on this port. | 
|  | 1086 | */ | 
|  | 1087 | if (wait) { | 
|  | 1088 | wait_event_interruptible(portp->raw_wait, | 
|  | 1089 | !test_bit(ST_CLOSING, &portp->state)); | 
|  | 1090 | if (signal_pending(current)) { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1091 | return -ERESTARTSYS; | 
|  | 1092 | } | 
|  | 1093 | } | 
|  | 1094 |  | 
|  | 1095 | /* | 
|  | 1096 | *	Write the close command into shared memory. | 
|  | 1097 | */ | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1098 | spin_lock_irqsave(&brd_lock, flags); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1099 | EBRDENABLE(brdp); | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1100 | cp = &((cdkasy_t __iomem *) EBRDGETMEMPTR(brdp, portp->addr))->ctrl; | 
|  | 1101 | writel(arg, &cp->closearg); | 
|  | 1102 | writeb(1, &cp->close); | 
|  | 1103 | hdrp = (cdkhdr_t __iomem *) EBRDGETMEMPTR(brdp, CDK_CDKADDR); | 
|  | 1104 | bits = ((unsigned char __iomem *) hdrp) + brdp->slaveoffset + | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1105 | portp->portidx; | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1106 | writeb(readb(bits) |portp->portbit, bits); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1107 | EBRDDISABLE(brdp); | 
|  | 1108 |  | 
|  | 1109 | set_bit(ST_CLOSING, &portp->state); | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1110 | spin_unlock_irqrestore(&brd_lock, flags); | 
|  | 1111 |  | 
|  | 1112 | if (wait == 0) | 
|  | 1113 | return 0; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1114 |  | 
|  | 1115 | /* | 
|  | 1116 | *	Slave is in action, so now we must wait for the open acknowledgment | 
|  | 1117 | *	to come back. | 
|  | 1118 | */ | 
|  | 1119 | rc = 0; | 
|  | 1120 | wait_event_interruptible(portp->raw_wait, | 
|  | 1121 | !test_bit(ST_CLOSING, &portp->state)); | 
|  | 1122 | if (signal_pending(current)) | 
|  | 1123 | rc = -ERESTARTSYS; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1124 |  | 
|  | 1125 | if ((rc == 0) && (portp->rc != 0)) | 
|  | 1126 | rc = -EIO; | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1127 | return rc; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1128 | } | 
|  | 1129 |  | 
|  | 1130 | /*****************************************************************************/ | 
|  | 1131 |  | 
|  | 1132 | /* | 
|  | 1133 | *	Send a command to the slave and wait for the response. This must | 
|  | 1134 | *	have user context (it sleeps). This routine is generic in that it | 
|  | 1135 | *	can send any type of command. Its purpose is to wait for that command | 
|  | 1136 | *	to complete (as opposed to initiating the command then returning). | 
|  | 1137 | */ | 
|  | 1138 |  | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 1139 | static int stli_cmdwait(struct stlibrd *brdp, struct stliport *portp, unsigned long cmd, void *arg, int size, int copyback) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1140 | { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1141 | wait_event_interruptible(portp->raw_wait, | 
|  | 1142 | !test_bit(ST_CMDING, &portp->state)); | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1143 | if (signal_pending(current)) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1144 | return -ERESTARTSYS; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1145 |  | 
|  | 1146 | stli_sendcmd(brdp, portp, cmd, arg, size, copyback); | 
|  | 1147 |  | 
|  | 1148 | wait_event_interruptible(portp->raw_wait, | 
|  | 1149 | !test_bit(ST_CMDING, &portp->state)); | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1150 | if (signal_pending(current)) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1151 | return -ERESTARTSYS; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1152 |  | 
|  | 1153 | if (portp->rc != 0) | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1154 | return -EIO; | 
|  | 1155 | return 0; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1156 | } | 
|  | 1157 |  | 
|  | 1158 | /*****************************************************************************/ | 
|  | 1159 |  | 
|  | 1160 | /* | 
|  | 1161 | *	Send the termios settings for this port to the slave. This sleeps | 
|  | 1162 | *	waiting for the command to complete - so must have user context. | 
|  | 1163 | */ | 
|  | 1164 |  | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 1165 | static int stli_setport(struct stliport *portp) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1166 | { | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 1167 | struct stlibrd *brdp; | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1168 | asyport_t aport; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1169 |  | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1170 | if (portp == NULL) | 
|  | 1171 | return -ENODEV; | 
|  | 1172 | if (portp->tty == NULL) | 
|  | 1173 | return -ENODEV; | 
| Jiri Slaby | 1328d73 | 2006-12-08 02:39:19 -0800 | [diff] [blame] | 1174 | if (portp->brdnr >= stli_nrbrds) | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1175 | return -ENODEV; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1176 | brdp = stli_brds[portp->brdnr]; | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1177 | if (brdp == NULL) | 
|  | 1178 | return -ENODEV; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1179 |  | 
|  | 1180 | stli_mkasyport(portp, &aport, portp->tty->termios); | 
|  | 1181 | return(stli_cmdwait(brdp, portp, A_SETPORT, &aport, sizeof(asyport_t), 0)); | 
|  | 1182 | } | 
|  | 1183 |  | 
|  | 1184 | /*****************************************************************************/ | 
|  | 1185 |  | 
|  | 1186 | /* | 
|  | 1187 | *	Possibly need to wait for carrier (DCD signal) to come high. Say | 
|  | 1188 | *	maybe because if we are clocal then we don't need to wait... | 
|  | 1189 | */ | 
|  | 1190 |  | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 1191 | static int stli_waitcarrier(struct stlibrd *brdp, struct stliport *portp, struct file *filp) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1192 | { | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1193 | unsigned long flags; | 
|  | 1194 | int rc, doclocal; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1195 |  | 
|  | 1196 | rc = 0; | 
|  | 1197 | doclocal = 0; | 
|  | 1198 |  | 
|  | 1199 | if (portp->tty->termios->c_cflag & CLOCAL) | 
|  | 1200 | doclocal++; | 
|  | 1201 |  | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1202 | spin_lock_irqsave(&stli_lock, flags); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1203 | portp->openwaitcnt++; | 
|  | 1204 | if (! tty_hung_up_p(filp)) | 
|  | 1205 | portp->refcount--; | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1206 | spin_unlock_irqrestore(&stli_lock, flags); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1207 |  | 
|  | 1208 | for (;;) { | 
|  | 1209 | stli_mkasysigs(&portp->asig, 1, 1); | 
|  | 1210 | if ((rc = stli_cmdwait(brdp, portp, A_SETSIGNALS, | 
|  | 1211 | &portp->asig, sizeof(asysigs_t), 0)) < 0) | 
|  | 1212 | break; | 
|  | 1213 | if (tty_hung_up_p(filp) || | 
|  | 1214 | ((portp->flags & ASYNC_INITIALIZED) == 0)) { | 
|  | 1215 | if (portp->flags & ASYNC_HUP_NOTIFY) | 
|  | 1216 | rc = -EBUSY; | 
|  | 1217 | else | 
|  | 1218 | rc = -ERESTARTSYS; | 
|  | 1219 | break; | 
|  | 1220 | } | 
|  | 1221 | if (((portp->flags & ASYNC_CLOSING) == 0) && | 
|  | 1222 | (doclocal || (portp->sigs & TIOCM_CD))) { | 
|  | 1223 | break; | 
|  | 1224 | } | 
|  | 1225 | if (signal_pending(current)) { | 
|  | 1226 | rc = -ERESTARTSYS; | 
|  | 1227 | break; | 
|  | 1228 | } | 
|  | 1229 | interruptible_sleep_on(&portp->open_wait); | 
|  | 1230 | } | 
|  | 1231 |  | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1232 | spin_lock_irqsave(&stli_lock, flags); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1233 | if (! tty_hung_up_p(filp)) | 
|  | 1234 | portp->refcount++; | 
|  | 1235 | portp->openwaitcnt--; | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1236 | spin_unlock_irqrestore(&stli_lock, flags); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1237 |  | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1238 | return rc; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1239 | } | 
|  | 1240 |  | 
|  | 1241 | /*****************************************************************************/ | 
|  | 1242 |  | 
|  | 1243 | /* | 
|  | 1244 | *	Write routine. Take the data and put it in the shared memory ring | 
|  | 1245 | *	queue. If port is not already sending chars then need to mark the | 
|  | 1246 | *	service bits for this port. | 
|  | 1247 | */ | 
|  | 1248 |  | 
|  | 1249 | static int stli_write(struct tty_struct *tty, const unsigned char *buf, int count) | 
|  | 1250 | { | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1251 | cdkasy_t __iomem *ap; | 
|  | 1252 | cdkhdr_t __iomem *hdrp; | 
|  | 1253 | unsigned char __iomem *bits; | 
|  | 1254 | unsigned char __iomem *shbuf; | 
|  | 1255 | unsigned char *chbuf; | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 1256 | struct stliport *portp; | 
|  | 1257 | struct stlibrd *brdp; | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1258 | unsigned int len, stlen, head, tail, size; | 
|  | 1259 | unsigned long flags; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1260 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1261 | if (tty == stli_txcooktty) | 
|  | 1262 | stli_flushchars(tty); | 
|  | 1263 | portp = tty->driver_data; | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1264 | if (portp == NULL) | 
|  | 1265 | return 0; | 
| Jiri Slaby | 1328d73 | 2006-12-08 02:39:19 -0800 | [diff] [blame] | 1266 | if (portp->brdnr >= stli_nrbrds) | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1267 | return 0; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1268 | brdp = stli_brds[portp->brdnr]; | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1269 | if (brdp == NULL) | 
|  | 1270 | return 0; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1271 | chbuf = (unsigned char *) buf; | 
|  | 1272 |  | 
|  | 1273 | /* | 
|  | 1274 | *	All data is now local, shove as much as possible into shared memory. | 
|  | 1275 | */ | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1276 | spin_lock_irqsave(&brd_lock, flags); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1277 | EBRDENABLE(brdp); | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1278 | ap = (cdkasy_t __iomem *) EBRDGETMEMPTR(brdp, portp->addr); | 
|  | 1279 | head = (unsigned int) readw(&ap->txq.head); | 
|  | 1280 | tail = (unsigned int) readw(&ap->txq.tail); | 
|  | 1281 | if (tail != ((unsigned int) readw(&ap->txq.tail))) | 
|  | 1282 | tail = (unsigned int) readw(&ap->txq.tail); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1283 | size = portp->txsize; | 
|  | 1284 | if (head >= tail) { | 
|  | 1285 | len = size - (head - tail) - 1; | 
|  | 1286 | stlen = size - head; | 
|  | 1287 | } else { | 
|  | 1288 | len = tail - head - 1; | 
|  | 1289 | stlen = len; | 
|  | 1290 | } | 
|  | 1291 |  | 
| Jiri Slaby | a3f8d9d | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 1292 | len = min(len, (unsigned int)count); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1293 | count = 0; | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1294 | shbuf = (char __iomem *) EBRDGETMEMPTR(brdp, portp->txoffset); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1295 |  | 
|  | 1296 | while (len > 0) { | 
| Jiri Slaby | a3f8d9d | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 1297 | stlen = min(len, stlen); | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1298 | memcpy_toio(shbuf + head, chbuf, stlen); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1299 | chbuf += stlen; | 
|  | 1300 | len -= stlen; | 
|  | 1301 | count += stlen; | 
|  | 1302 | head += stlen; | 
|  | 1303 | if (head >= size) { | 
|  | 1304 | head = 0; | 
|  | 1305 | stlen = tail; | 
|  | 1306 | } | 
|  | 1307 | } | 
|  | 1308 |  | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1309 | ap = (cdkasy_t __iomem *) EBRDGETMEMPTR(brdp, portp->addr); | 
|  | 1310 | writew(head, &ap->txq.head); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1311 | if (test_bit(ST_TXBUSY, &portp->state)) { | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1312 | if (readl(&ap->changed.data) & DT_TXEMPTY) | 
|  | 1313 | writel(readl(&ap->changed.data) & ~DT_TXEMPTY, &ap->changed.data); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1314 | } | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1315 | hdrp = (cdkhdr_t __iomem *) EBRDGETMEMPTR(brdp, CDK_CDKADDR); | 
|  | 1316 | bits = ((unsigned char __iomem *) hdrp) + brdp->slaveoffset + | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1317 | portp->portidx; | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1318 | writeb(readb(bits) | portp->portbit, bits); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1319 | set_bit(ST_TXBUSY, &portp->state); | 
|  | 1320 | EBRDDISABLE(brdp); | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1321 | spin_unlock_irqrestore(&brd_lock, flags); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1322 |  | 
|  | 1323 | return(count); | 
|  | 1324 | } | 
|  | 1325 |  | 
|  | 1326 | /*****************************************************************************/ | 
|  | 1327 |  | 
|  | 1328 | /* | 
|  | 1329 | *	Output a single character. We put it into a temporary local buffer | 
|  | 1330 | *	(for speed) then write out that buffer when the flushchars routine | 
|  | 1331 | *	is called. There is a safety catch here so that if some other port | 
|  | 1332 | *	writes chars before the current buffer has been, then we write them | 
|  | 1333 | *	first them do the new ports. | 
|  | 1334 | */ | 
|  | 1335 |  | 
|  | 1336 | static void stli_putchar(struct tty_struct *tty, unsigned char ch) | 
|  | 1337 | { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1338 | if (tty != stli_txcooktty) { | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1339 | if (stli_txcooktty != NULL) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1340 | stli_flushchars(stli_txcooktty); | 
|  | 1341 | stli_txcooktty = tty; | 
|  | 1342 | } | 
|  | 1343 |  | 
|  | 1344 | stli_txcookbuf[stli_txcooksize++] = ch; | 
|  | 1345 | } | 
|  | 1346 |  | 
|  | 1347 | /*****************************************************************************/ | 
|  | 1348 |  | 
|  | 1349 | /* | 
|  | 1350 | *	Transfer characters from the local TX cooking buffer to the board. | 
|  | 1351 | *	We sort of ignore the tty that gets passed in here. We rely on the | 
|  | 1352 | *	info stored with the TX cook buffer to tell us which port to flush | 
|  | 1353 | *	the data on. In any case we clean out the TX cook buffer, for re-use | 
|  | 1354 | *	by someone else. | 
|  | 1355 | */ | 
|  | 1356 |  | 
|  | 1357 | static void stli_flushchars(struct tty_struct *tty) | 
|  | 1358 | { | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1359 | cdkhdr_t __iomem *hdrp; | 
|  | 1360 | unsigned char __iomem *bits; | 
|  | 1361 | cdkasy_t __iomem *ap; | 
|  | 1362 | struct tty_struct *cooktty; | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 1363 | struct stliport *portp; | 
|  | 1364 | struct stlibrd *brdp; | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1365 | unsigned int len, stlen, head, tail, size, count, cooksize; | 
|  | 1366 | unsigned char *buf; | 
|  | 1367 | unsigned char __iomem *shbuf; | 
|  | 1368 | unsigned long flags; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1369 |  | 
|  | 1370 | cooksize = stli_txcooksize; | 
|  | 1371 | cooktty = stli_txcooktty; | 
|  | 1372 | stli_txcooksize = 0; | 
|  | 1373 | stli_txcookrealsize = 0; | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1374 | stli_txcooktty = NULL; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1375 |  | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1376 | if (tty == NULL) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1377 | return; | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1378 | if (cooktty == NULL) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1379 | return; | 
|  | 1380 | if (tty != cooktty) | 
|  | 1381 | tty = cooktty; | 
|  | 1382 | if (cooksize == 0) | 
|  | 1383 | return; | 
|  | 1384 |  | 
|  | 1385 | portp = tty->driver_data; | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1386 | if (portp == NULL) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1387 | return; | 
| Jiri Slaby | 1328d73 | 2006-12-08 02:39:19 -0800 | [diff] [blame] | 1388 | if (portp->brdnr >= stli_nrbrds) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1389 | return; | 
|  | 1390 | brdp = stli_brds[portp->brdnr]; | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1391 | if (brdp == NULL) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1392 | return; | 
|  | 1393 |  | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1394 | spin_lock_irqsave(&brd_lock, flags); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1395 | EBRDENABLE(brdp); | 
|  | 1396 |  | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1397 | ap = (cdkasy_t __iomem *) EBRDGETMEMPTR(brdp, portp->addr); | 
|  | 1398 | head = (unsigned int) readw(&ap->txq.head); | 
|  | 1399 | tail = (unsigned int) readw(&ap->txq.tail); | 
|  | 1400 | if (tail != ((unsigned int) readw(&ap->txq.tail))) | 
|  | 1401 | tail = (unsigned int) readw(&ap->txq.tail); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1402 | size = portp->txsize; | 
|  | 1403 | if (head >= tail) { | 
|  | 1404 | len = size - (head - tail) - 1; | 
|  | 1405 | stlen = size - head; | 
|  | 1406 | } else { | 
|  | 1407 | len = tail - head - 1; | 
|  | 1408 | stlen = len; | 
|  | 1409 | } | 
|  | 1410 |  | 
| Jiri Slaby | a3f8d9d | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 1411 | len = min(len, cooksize); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1412 | count = 0; | 
| Al Viro | 29756fa | 2006-10-10 22:47:27 +0100 | [diff] [blame] | 1413 | shbuf = EBRDGETMEMPTR(brdp, portp->txoffset); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1414 | buf = stli_txcookbuf; | 
|  | 1415 |  | 
|  | 1416 | while (len > 0) { | 
| Jiri Slaby | a3f8d9d | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 1417 | stlen = min(len, stlen); | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1418 | memcpy_toio(shbuf + head, buf, stlen); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1419 | buf += stlen; | 
|  | 1420 | len -= stlen; | 
|  | 1421 | count += stlen; | 
|  | 1422 | head += stlen; | 
|  | 1423 | if (head >= size) { | 
|  | 1424 | head = 0; | 
|  | 1425 | stlen = tail; | 
|  | 1426 | } | 
|  | 1427 | } | 
|  | 1428 |  | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1429 | ap = (cdkasy_t __iomem *) EBRDGETMEMPTR(brdp, portp->addr); | 
|  | 1430 | writew(head, &ap->txq.head); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1431 |  | 
|  | 1432 | if (test_bit(ST_TXBUSY, &portp->state)) { | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1433 | if (readl(&ap->changed.data) & DT_TXEMPTY) | 
|  | 1434 | writel(readl(&ap->changed.data) & ~DT_TXEMPTY, &ap->changed.data); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1435 | } | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1436 | hdrp = (cdkhdr_t __iomem *) EBRDGETMEMPTR(brdp, CDK_CDKADDR); | 
|  | 1437 | bits = ((unsigned char __iomem *) hdrp) + brdp->slaveoffset + | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1438 | portp->portidx; | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1439 | writeb(readb(bits) | portp->portbit, bits); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1440 | set_bit(ST_TXBUSY, &portp->state); | 
|  | 1441 |  | 
|  | 1442 | EBRDDISABLE(brdp); | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1443 | spin_unlock_irqrestore(&brd_lock, flags); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1444 | } | 
|  | 1445 |  | 
|  | 1446 | /*****************************************************************************/ | 
|  | 1447 |  | 
|  | 1448 | static int stli_writeroom(struct tty_struct *tty) | 
|  | 1449 | { | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1450 | cdkasyrq_t __iomem *rp; | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 1451 | struct stliport *portp; | 
|  | 1452 | struct stlibrd *brdp; | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1453 | unsigned int head, tail, len; | 
|  | 1454 | unsigned long flags; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1455 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1456 | if (tty == stli_txcooktty) { | 
|  | 1457 | if (stli_txcookrealsize != 0) { | 
|  | 1458 | len = stli_txcookrealsize - stli_txcooksize; | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1459 | return len; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1460 | } | 
|  | 1461 | } | 
|  | 1462 |  | 
|  | 1463 | portp = tty->driver_data; | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1464 | if (portp == NULL) | 
|  | 1465 | return 0; | 
| Jiri Slaby | 1328d73 | 2006-12-08 02:39:19 -0800 | [diff] [blame] | 1466 | if (portp->brdnr >= stli_nrbrds) | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1467 | return 0; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1468 | brdp = stli_brds[portp->brdnr]; | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1469 | if (brdp == NULL) | 
|  | 1470 | return 0; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1471 |  | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1472 | spin_lock_irqsave(&brd_lock, flags); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1473 | EBRDENABLE(brdp); | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1474 | rp = &((cdkasy_t __iomem *) EBRDGETMEMPTR(brdp, portp->addr))->txq; | 
|  | 1475 | head = (unsigned int) readw(&rp->head); | 
|  | 1476 | tail = (unsigned int) readw(&rp->tail); | 
|  | 1477 | if (tail != ((unsigned int) readw(&rp->tail))) | 
|  | 1478 | tail = (unsigned int) readw(&rp->tail); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1479 | len = (head >= tail) ? (portp->txsize - (head - tail)) : (tail - head); | 
|  | 1480 | len--; | 
|  | 1481 | EBRDDISABLE(brdp); | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1482 | spin_unlock_irqrestore(&brd_lock, flags); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1483 |  | 
|  | 1484 | if (tty == stli_txcooktty) { | 
|  | 1485 | stli_txcookrealsize = len; | 
|  | 1486 | len -= stli_txcooksize; | 
|  | 1487 | } | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1488 | return len; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1489 | } | 
|  | 1490 |  | 
|  | 1491 | /*****************************************************************************/ | 
|  | 1492 |  | 
|  | 1493 | /* | 
|  | 1494 | *	Return the number of characters in the transmit buffer. Normally we | 
|  | 1495 | *	will return the number of chars in the shared memory ring queue. | 
|  | 1496 | *	We need to kludge around the case where the shared memory buffer is | 
|  | 1497 | *	empty but not all characters have drained yet, for this case just | 
|  | 1498 | *	return that there is 1 character in the buffer! | 
|  | 1499 | */ | 
|  | 1500 |  | 
|  | 1501 | static int stli_charsinbuffer(struct tty_struct *tty) | 
|  | 1502 | { | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1503 | cdkasyrq_t __iomem *rp; | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 1504 | struct stliport *portp; | 
|  | 1505 | struct stlibrd *brdp; | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1506 | unsigned int head, tail, len; | 
|  | 1507 | unsigned long flags; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1508 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1509 | if (tty == stli_txcooktty) | 
|  | 1510 | stli_flushchars(tty); | 
|  | 1511 | portp = tty->driver_data; | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1512 | if (portp == NULL) | 
|  | 1513 | return 0; | 
| Jiri Slaby | 1328d73 | 2006-12-08 02:39:19 -0800 | [diff] [blame] | 1514 | if (portp->brdnr >= stli_nrbrds) | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1515 | return 0; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1516 | brdp = stli_brds[portp->brdnr]; | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1517 | if (brdp == NULL) | 
|  | 1518 | return 0; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1519 |  | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1520 | spin_lock_irqsave(&brd_lock, flags); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1521 | EBRDENABLE(brdp); | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1522 | rp = &((cdkasy_t __iomem *) EBRDGETMEMPTR(brdp, portp->addr))->txq; | 
|  | 1523 | head = (unsigned int) readw(&rp->head); | 
|  | 1524 | tail = (unsigned int) readw(&rp->tail); | 
|  | 1525 | if (tail != ((unsigned int) readw(&rp->tail))) | 
|  | 1526 | tail = (unsigned int) readw(&rp->tail); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1527 | len = (head >= tail) ? (head - tail) : (portp->txsize - (tail - head)); | 
|  | 1528 | if ((len == 0) && test_bit(ST_TXBUSY, &portp->state)) | 
|  | 1529 | len = 1; | 
|  | 1530 | EBRDDISABLE(brdp); | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1531 | spin_unlock_irqrestore(&brd_lock, flags); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1532 |  | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1533 | return len; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1534 | } | 
|  | 1535 |  | 
|  | 1536 | /*****************************************************************************/ | 
|  | 1537 |  | 
|  | 1538 | /* | 
|  | 1539 | *	Generate the serial struct info. | 
|  | 1540 | */ | 
|  | 1541 |  | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 1542 | static int stli_getserial(struct stliport *portp, struct serial_struct __user *sp) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1543 | { | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1544 | struct serial_struct sio; | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 1545 | struct stlibrd *brdp; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1546 |  | 
|  | 1547 | memset(&sio, 0, sizeof(struct serial_struct)); | 
|  | 1548 | sio.type = PORT_UNKNOWN; | 
|  | 1549 | sio.line = portp->portnr; | 
|  | 1550 | sio.irq = 0; | 
|  | 1551 | sio.flags = portp->flags; | 
|  | 1552 | sio.baud_base = portp->baud_base; | 
|  | 1553 | sio.close_delay = portp->close_delay; | 
|  | 1554 | sio.closing_wait = portp->closing_wait; | 
|  | 1555 | sio.custom_divisor = portp->custom_divisor; | 
|  | 1556 | sio.xmit_fifo_size = 0; | 
|  | 1557 | sio.hub6 = 0; | 
|  | 1558 |  | 
|  | 1559 | brdp = stli_brds[portp->brdnr]; | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1560 | if (brdp != NULL) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1561 | sio.port = brdp->iobase; | 
|  | 1562 |  | 
|  | 1563 | return copy_to_user(sp, &sio, sizeof(struct serial_struct)) ? | 
|  | 1564 | -EFAULT : 0; | 
|  | 1565 | } | 
|  | 1566 |  | 
|  | 1567 | /*****************************************************************************/ | 
|  | 1568 |  | 
|  | 1569 | /* | 
|  | 1570 | *	Set port according to the serial struct info. | 
|  | 1571 | *	At this point we do not do any auto-configure stuff, so we will | 
|  | 1572 | *	just quietly ignore any requests to change irq, etc. | 
|  | 1573 | */ | 
|  | 1574 |  | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 1575 | static int stli_setserial(struct stliport *portp, struct serial_struct __user *sp) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1576 | { | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1577 | struct serial_struct sio; | 
|  | 1578 | int rc; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1579 |  | 
|  | 1580 | if (copy_from_user(&sio, sp, sizeof(struct serial_struct))) | 
|  | 1581 | return -EFAULT; | 
|  | 1582 | if (!capable(CAP_SYS_ADMIN)) { | 
|  | 1583 | if ((sio.baud_base != portp->baud_base) || | 
|  | 1584 | (sio.close_delay != portp->close_delay) || | 
|  | 1585 | ((sio.flags & ~ASYNC_USR_MASK) != | 
|  | 1586 | (portp->flags & ~ASYNC_USR_MASK))) | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1587 | return -EPERM; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1588 | } | 
|  | 1589 |  | 
|  | 1590 | portp->flags = (portp->flags & ~ASYNC_USR_MASK) | | 
|  | 1591 | (sio.flags & ASYNC_USR_MASK); | 
|  | 1592 | portp->baud_base = sio.baud_base; | 
|  | 1593 | portp->close_delay = sio.close_delay; | 
|  | 1594 | portp->closing_wait = sio.closing_wait; | 
|  | 1595 | portp->custom_divisor = sio.custom_divisor; | 
|  | 1596 |  | 
|  | 1597 | if ((rc = stli_setport(portp)) < 0) | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1598 | return rc; | 
|  | 1599 | return 0; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1600 | } | 
|  | 1601 |  | 
|  | 1602 | /*****************************************************************************/ | 
|  | 1603 |  | 
|  | 1604 | static int stli_tiocmget(struct tty_struct *tty, struct file *file) | 
|  | 1605 | { | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 1606 | struct stliport *portp = tty->driver_data; | 
|  | 1607 | struct stlibrd *brdp; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1608 | int rc; | 
|  | 1609 |  | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1610 | if (portp == NULL) | 
|  | 1611 | return -ENODEV; | 
| Jiri Slaby | 1328d73 | 2006-12-08 02:39:19 -0800 | [diff] [blame] | 1612 | if (portp->brdnr >= stli_nrbrds) | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1613 | return 0; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1614 | brdp = stli_brds[portp->brdnr]; | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1615 | if (brdp == NULL) | 
|  | 1616 | return 0; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1617 | if (tty->flags & (1 << TTY_IO_ERROR)) | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1618 | return -EIO; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1619 |  | 
|  | 1620 | if ((rc = stli_cmdwait(brdp, portp, A_GETSIGNALS, | 
|  | 1621 | &portp->asig, sizeof(asysigs_t), 1)) < 0) | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1622 | return rc; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1623 |  | 
|  | 1624 | return stli_mktiocm(portp->asig.sigvalue); | 
|  | 1625 | } | 
|  | 1626 |  | 
|  | 1627 | static int stli_tiocmset(struct tty_struct *tty, struct file *file, | 
|  | 1628 | unsigned int set, unsigned int clear) | 
|  | 1629 | { | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 1630 | struct stliport *portp = tty->driver_data; | 
|  | 1631 | struct stlibrd *brdp; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1632 | int rts = -1, dtr = -1; | 
|  | 1633 |  | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1634 | if (portp == NULL) | 
|  | 1635 | return -ENODEV; | 
| Jiri Slaby | 1328d73 | 2006-12-08 02:39:19 -0800 | [diff] [blame] | 1636 | if (portp->brdnr >= stli_nrbrds) | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1637 | return 0; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1638 | brdp = stli_brds[portp->brdnr]; | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1639 | if (brdp == NULL) | 
|  | 1640 | return 0; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1641 | if (tty->flags & (1 << TTY_IO_ERROR)) | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1642 | return -EIO; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1643 |  | 
|  | 1644 | if (set & TIOCM_RTS) | 
|  | 1645 | rts = 1; | 
|  | 1646 | if (set & TIOCM_DTR) | 
|  | 1647 | dtr = 1; | 
|  | 1648 | if (clear & TIOCM_RTS) | 
|  | 1649 | rts = 0; | 
|  | 1650 | if (clear & TIOCM_DTR) | 
|  | 1651 | dtr = 0; | 
|  | 1652 |  | 
|  | 1653 | stli_mkasysigs(&portp->asig, dtr, rts); | 
|  | 1654 |  | 
|  | 1655 | return stli_cmdwait(brdp, portp, A_SETSIGNALS, &portp->asig, | 
|  | 1656 | sizeof(asysigs_t), 0); | 
|  | 1657 | } | 
|  | 1658 |  | 
|  | 1659 | static int stli_ioctl(struct tty_struct *tty, struct file *file, unsigned int cmd, unsigned long arg) | 
|  | 1660 | { | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 1661 | struct stliport *portp; | 
|  | 1662 | struct stlibrd *brdp; | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1663 | unsigned int ival; | 
|  | 1664 | int rc; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1665 | void __user *argp = (void __user *)arg; | 
|  | 1666 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1667 | portp = tty->driver_data; | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1668 | if (portp == NULL) | 
|  | 1669 | return -ENODEV; | 
| Jiri Slaby | 1328d73 | 2006-12-08 02:39:19 -0800 | [diff] [blame] | 1670 | if (portp->brdnr >= stli_nrbrds) | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1671 | return 0; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1672 | brdp = stli_brds[portp->brdnr]; | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1673 | if (brdp == NULL) | 
|  | 1674 | return 0; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1675 |  | 
|  | 1676 | if ((cmd != TIOCGSERIAL) && (cmd != TIOCSSERIAL) && | 
|  | 1677 | (cmd != COM_GETPORTSTATS) && (cmd != COM_CLRPORTSTATS)) { | 
|  | 1678 | if (tty->flags & (1 << TTY_IO_ERROR)) | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1679 | return -EIO; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1680 | } | 
|  | 1681 |  | 
|  | 1682 | rc = 0; | 
|  | 1683 |  | 
|  | 1684 | switch (cmd) { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1685 | case TIOCGSERIAL: | 
|  | 1686 | rc = stli_getserial(portp, argp); | 
|  | 1687 | break; | 
|  | 1688 | case TIOCSSERIAL: | 
|  | 1689 | rc = stli_setserial(portp, argp); | 
|  | 1690 | break; | 
|  | 1691 | case STL_GETPFLAG: | 
|  | 1692 | rc = put_user(portp->pflag, (unsigned __user *)argp); | 
|  | 1693 | break; | 
|  | 1694 | case STL_SETPFLAG: | 
|  | 1695 | if ((rc = get_user(portp->pflag, (unsigned __user *)argp)) == 0) | 
|  | 1696 | stli_setport(portp); | 
|  | 1697 | break; | 
|  | 1698 | case COM_GETPORTSTATS: | 
|  | 1699 | rc = stli_getportstats(portp, argp); | 
|  | 1700 | break; | 
|  | 1701 | case COM_CLRPORTSTATS: | 
|  | 1702 | rc = stli_clrportstats(portp, argp); | 
|  | 1703 | break; | 
|  | 1704 | case TIOCSERCONFIG: | 
|  | 1705 | case TIOCSERGWILD: | 
|  | 1706 | case TIOCSERSWILD: | 
|  | 1707 | case TIOCSERGETLSR: | 
|  | 1708 | case TIOCSERGSTRUCT: | 
|  | 1709 | case TIOCSERGETMULTI: | 
|  | 1710 | case TIOCSERSETMULTI: | 
|  | 1711 | default: | 
|  | 1712 | rc = -ENOIOCTLCMD; | 
|  | 1713 | break; | 
|  | 1714 | } | 
|  | 1715 |  | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1716 | return rc; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1717 | } | 
|  | 1718 |  | 
|  | 1719 | /*****************************************************************************/ | 
|  | 1720 |  | 
|  | 1721 | /* | 
|  | 1722 | *	This routine assumes that we have user context and can sleep. | 
|  | 1723 | *	Looks like it is true for the current ttys implementation..!! | 
|  | 1724 | */ | 
|  | 1725 |  | 
| Alan Cox | 606d099 | 2006-12-08 02:38:45 -0800 | [diff] [blame] | 1726 | static void stli_settermios(struct tty_struct *tty, struct ktermios *old) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1727 | { | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 1728 | struct stliport *portp; | 
|  | 1729 | struct stlibrd *brdp; | 
| Alan Cox | 606d099 | 2006-12-08 02:38:45 -0800 | [diff] [blame] | 1730 | struct ktermios *tiosp; | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1731 | asyport_t aport; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1732 |  | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1733 | if (tty == NULL) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1734 | return; | 
|  | 1735 | portp = tty->driver_data; | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1736 | if (portp == NULL) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1737 | return; | 
| Jiri Slaby | 1328d73 | 2006-12-08 02:39:19 -0800 | [diff] [blame] | 1738 | if (portp->brdnr >= stli_nrbrds) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1739 | return; | 
|  | 1740 | brdp = stli_brds[portp->brdnr]; | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1741 | if (brdp == NULL) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1742 | return; | 
|  | 1743 |  | 
|  | 1744 | tiosp = tty->termios; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1745 |  | 
|  | 1746 | stli_mkasyport(portp, &aport, tiosp); | 
|  | 1747 | stli_cmdwait(brdp, portp, A_SETPORT, &aport, sizeof(asyport_t), 0); | 
|  | 1748 | stli_mkasysigs(&portp->asig, ((tiosp->c_cflag & CBAUD) ? 1 : 0), -1); | 
|  | 1749 | stli_cmdwait(brdp, portp, A_SETSIGNALS, &portp->asig, | 
|  | 1750 | sizeof(asysigs_t), 0); | 
|  | 1751 | if ((old->c_cflag & CRTSCTS) && ((tiosp->c_cflag & CRTSCTS) == 0)) | 
|  | 1752 | tty->hw_stopped = 0; | 
|  | 1753 | if (((old->c_cflag & CLOCAL) == 0) && (tiosp->c_cflag & CLOCAL)) | 
|  | 1754 | wake_up_interruptible(&portp->open_wait); | 
|  | 1755 | } | 
|  | 1756 |  | 
|  | 1757 | /*****************************************************************************/ | 
|  | 1758 |  | 
|  | 1759 | /* | 
|  | 1760 | *	Attempt to flow control who ever is sending us data. We won't really | 
|  | 1761 | *	do any flow control action here. We can't directly, and even if we | 
|  | 1762 | *	wanted to we would have to send a command to the slave. The slave | 
|  | 1763 | *	knows how to flow control, and will do so when its buffers reach its | 
|  | 1764 | *	internal high water marks. So what we will do is set a local state | 
|  | 1765 | *	bit that will stop us sending any RX data up from the poll routine | 
|  | 1766 | *	(which is the place where RX data from the slave is handled). | 
|  | 1767 | */ | 
|  | 1768 |  | 
|  | 1769 | static void stli_throttle(struct tty_struct *tty) | 
|  | 1770 | { | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 1771 | struct stliport	*portp = tty->driver_data; | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1772 | if (portp == NULL) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1773 | return; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1774 | set_bit(ST_RXSTOP, &portp->state); | 
|  | 1775 | } | 
|  | 1776 |  | 
|  | 1777 | /*****************************************************************************/ | 
|  | 1778 |  | 
|  | 1779 | /* | 
|  | 1780 | *	Unflow control the device sending us data... That means that all | 
|  | 1781 | *	we have to do is clear the RXSTOP state bit. The next poll call | 
|  | 1782 | *	will then be able to pass the RX data back up. | 
|  | 1783 | */ | 
|  | 1784 |  | 
|  | 1785 | static void stli_unthrottle(struct tty_struct *tty) | 
|  | 1786 | { | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 1787 | struct stliport	*portp = tty->driver_data; | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1788 | if (portp == NULL) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1789 | return; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1790 | clear_bit(ST_RXSTOP, &portp->state); | 
|  | 1791 | } | 
|  | 1792 |  | 
|  | 1793 | /*****************************************************************************/ | 
|  | 1794 |  | 
|  | 1795 | /* | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1796 | *	Stop the transmitter. | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1797 | */ | 
|  | 1798 |  | 
|  | 1799 | static void stli_stop(struct tty_struct *tty) | 
|  | 1800 | { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1801 | } | 
|  | 1802 |  | 
|  | 1803 | /*****************************************************************************/ | 
|  | 1804 |  | 
|  | 1805 | /* | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1806 | *	Start the transmitter again. | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1807 | */ | 
|  | 1808 |  | 
|  | 1809 | static void stli_start(struct tty_struct *tty) | 
|  | 1810 | { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1811 | } | 
|  | 1812 |  | 
|  | 1813 | /*****************************************************************************/ | 
|  | 1814 |  | 
|  | 1815 | /* | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1816 | *	Hangup this port. This is pretty much like closing the port, only | 
|  | 1817 | *	a little more brutal. No waiting for data to drain. Shutdown the | 
|  | 1818 | *	port and maybe drop signals. This is rather tricky really. We want | 
|  | 1819 | *	to close the port as well. | 
|  | 1820 | */ | 
|  | 1821 |  | 
|  | 1822 | static void stli_hangup(struct tty_struct *tty) | 
|  | 1823 | { | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 1824 | struct stliport *portp; | 
|  | 1825 | struct stlibrd *brdp; | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1826 | unsigned long flags; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1827 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1828 | portp = tty->driver_data; | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1829 | if (portp == NULL) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1830 | return; | 
| Jiri Slaby | 1328d73 | 2006-12-08 02:39:19 -0800 | [diff] [blame] | 1831 | if (portp->brdnr >= stli_nrbrds) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1832 | return; | 
|  | 1833 | brdp = stli_brds[portp->brdnr]; | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1834 | if (brdp == NULL) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1835 | return; | 
|  | 1836 |  | 
|  | 1837 | portp->flags &= ~ASYNC_INITIALIZED; | 
|  | 1838 |  | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1839 | if (!test_bit(ST_CLOSING, &portp->state)) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1840 | stli_rawclose(brdp, portp, 0, 0); | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1841 |  | 
|  | 1842 | spin_lock_irqsave(&stli_lock, flags); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1843 | if (tty->termios->c_cflag & HUPCL) { | 
|  | 1844 | stli_mkasysigs(&portp->asig, 0, 0); | 
|  | 1845 | if (test_bit(ST_CMDING, &portp->state)) { | 
|  | 1846 | set_bit(ST_DOSIGS, &portp->state); | 
|  | 1847 | set_bit(ST_DOFLUSHTX, &portp->state); | 
|  | 1848 | set_bit(ST_DOFLUSHRX, &portp->state); | 
|  | 1849 | } else { | 
|  | 1850 | stli_sendcmd(brdp, portp, A_SETSIGNALSF, | 
|  | 1851 | &portp->asig, sizeof(asysigs_t), 0); | 
|  | 1852 | } | 
|  | 1853 | } | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1854 |  | 
|  | 1855 | clear_bit(ST_TXBUSY, &portp->state); | 
|  | 1856 | clear_bit(ST_RXSTOP, &portp->state); | 
|  | 1857 | set_bit(TTY_IO_ERROR, &tty->flags); | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1858 | portp->tty = NULL; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1859 | portp->flags &= ~ASYNC_NORMAL_ACTIVE; | 
|  | 1860 | portp->refcount = 0; | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1861 | spin_unlock_irqrestore(&stli_lock, flags); | 
|  | 1862 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1863 | wake_up_interruptible(&portp->open_wait); | 
|  | 1864 | } | 
|  | 1865 |  | 
|  | 1866 | /*****************************************************************************/ | 
|  | 1867 |  | 
|  | 1868 | /* | 
|  | 1869 | *	Flush characters from the lower buffer. We may not have user context | 
|  | 1870 | *	so we cannot sleep waiting for it to complete. Also we need to check | 
|  | 1871 | *	if there is chars for this port in the TX cook buffer, and flush them | 
|  | 1872 | *	as well. | 
|  | 1873 | */ | 
|  | 1874 |  | 
|  | 1875 | static void stli_flushbuffer(struct tty_struct *tty) | 
|  | 1876 | { | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 1877 | struct stliport *portp; | 
|  | 1878 | struct stlibrd *brdp; | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1879 | unsigned long ftype, flags; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1880 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1881 | portp = tty->driver_data; | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1882 | if (portp == NULL) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1883 | return; | 
| Jiri Slaby | 1328d73 | 2006-12-08 02:39:19 -0800 | [diff] [blame] | 1884 | if (portp->brdnr >= stli_nrbrds) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1885 | return; | 
|  | 1886 | brdp = stli_brds[portp->brdnr]; | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1887 | if (brdp == NULL) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1888 | return; | 
|  | 1889 |  | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1890 | spin_lock_irqsave(&brd_lock, flags); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1891 | if (tty == stli_txcooktty) { | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1892 | stli_txcooktty = NULL; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1893 | stli_txcooksize = 0; | 
|  | 1894 | stli_txcookrealsize = 0; | 
|  | 1895 | } | 
|  | 1896 | if (test_bit(ST_CMDING, &portp->state)) { | 
|  | 1897 | set_bit(ST_DOFLUSHTX, &portp->state); | 
|  | 1898 | } else { | 
|  | 1899 | ftype = FLUSHTX; | 
|  | 1900 | if (test_bit(ST_DOFLUSHRX, &portp->state)) { | 
|  | 1901 | ftype |= FLUSHRX; | 
|  | 1902 | clear_bit(ST_DOFLUSHRX, &portp->state); | 
|  | 1903 | } | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1904 | __stli_sendcmd(brdp, portp, A_FLUSH, &ftype, sizeof(u32), 0); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1905 | } | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1906 | spin_unlock_irqrestore(&brd_lock, flags); | 
|  | 1907 | tty_wakeup(tty); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1908 | } | 
|  | 1909 |  | 
|  | 1910 | /*****************************************************************************/ | 
|  | 1911 |  | 
|  | 1912 | static void stli_breakctl(struct tty_struct *tty, int state) | 
|  | 1913 | { | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 1914 | struct stlibrd	*brdp; | 
|  | 1915 | struct stliport	*portp; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1916 | long		arg; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1917 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1918 | portp = tty->driver_data; | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1919 | if (portp == NULL) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1920 | return; | 
| Jiri Slaby | 1328d73 | 2006-12-08 02:39:19 -0800 | [diff] [blame] | 1921 | if (portp->brdnr >= stli_nrbrds) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1922 | return; | 
|  | 1923 | brdp = stli_brds[portp->brdnr]; | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1924 | if (brdp == NULL) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1925 | return; | 
|  | 1926 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1927 | arg = (state == -1) ? BREAKON : BREAKOFF; | 
|  | 1928 | stli_cmdwait(brdp, portp, A_BREAK, &arg, sizeof(long), 0); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1929 | } | 
|  | 1930 |  | 
|  | 1931 | /*****************************************************************************/ | 
|  | 1932 |  | 
|  | 1933 | static void stli_waituntilsent(struct tty_struct *tty, int timeout) | 
|  | 1934 | { | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 1935 | struct stliport *portp; | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1936 | unsigned long tend; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1937 |  | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1938 | if (tty == NULL) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1939 | return; | 
|  | 1940 | portp = tty->driver_data; | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1941 | if (portp == NULL) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1942 | return; | 
|  | 1943 |  | 
|  | 1944 | if (timeout == 0) | 
|  | 1945 | timeout = HZ; | 
|  | 1946 | tend = jiffies + timeout; | 
|  | 1947 |  | 
|  | 1948 | while (test_bit(ST_TXBUSY, &portp->state)) { | 
|  | 1949 | if (signal_pending(current)) | 
|  | 1950 | break; | 
|  | 1951 | msleep_interruptible(20); | 
|  | 1952 | if (time_after_eq(jiffies, tend)) | 
|  | 1953 | break; | 
|  | 1954 | } | 
|  | 1955 | } | 
|  | 1956 |  | 
|  | 1957 | /*****************************************************************************/ | 
|  | 1958 |  | 
|  | 1959 | static void stli_sendxchar(struct tty_struct *tty, char ch) | 
|  | 1960 | { | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 1961 | struct stlibrd	*brdp; | 
|  | 1962 | struct stliport	*portp; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1963 | asyctrl_t	actrl; | 
|  | 1964 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1965 | portp = tty->driver_data; | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1966 | if (portp == NULL) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1967 | return; | 
| Jiri Slaby | 1328d73 | 2006-12-08 02:39:19 -0800 | [diff] [blame] | 1968 | if (portp->brdnr >= stli_nrbrds) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1969 | return; | 
|  | 1970 | brdp = stli_brds[portp->brdnr]; | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1971 | if (brdp == NULL) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1972 | return; | 
|  | 1973 |  | 
|  | 1974 | memset(&actrl, 0, sizeof(asyctrl_t)); | 
|  | 1975 | if (ch == STOP_CHAR(tty)) { | 
|  | 1976 | actrl.rxctrl = CT_STOPFLOW; | 
|  | 1977 | } else if (ch == START_CHAR(tty)) { | 
|  | 1978 | actrl.rxctrl = CT_STARTFLOW; | 
|  | 1979 | } else { | 
|  | 1980 | actrl.txctrl = CT_SENDCHR; | 
|  | 1981 | actrl.tximdch = ch; | 
|  | 1982 | } | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1983 | stli_cmdwait(brdp, portp, A_PORTCTRL, &actrl, sizeof(asyctrl_t), 0); | 
|  | 1984 | } | 
|  | 1985 |  | 
|  | 1986 | /*****************************************************************************/ | 
|  | 1987 |  | 
|  | 1988 | #define	MAXLINE		80 | 
|  | 1989 |  | 
|  | 1990 | /* | 
|  | 1991 | *	Format info for a specified port. The line is deliberately limited | 
|  | 1992 | *	to 80 characters. (If it is too long it will be truncated, if too | 
|  | 1993 | *	short then padded with spaces). | 
|  | 1994 | */ | 
|  | 1995 |  | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 1996 | static int stli_portinfo(struct stlibrd *brdp, struct stliport *portp, int portnr, char *pos) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1997 | { | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 1998 | char *sp, *uart; | 
|  | 1999 | int rc, cnt; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2000 |  | 
|  | 2001 | rc = stli_portcmdstats(portp); | 
|  | 2002 |  | 
|  | 2003 | uart = "UNKNOWN"; | 
|  | 2004 | if (brdp->state & BST_STARTED) { | 
|  | 2005 | switch (stli_comstats.hwid) { | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 2006 | case 0:	uart = "2681"; break; | 
|  | 2007 | case 1:	uart = "SC26198"; break; | 
|  | 2008 | default:uart = "CD1400"; break; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2009 | } | 
|  | 2010 | } | 
|  | 2011 |  | 
|  | 2012 | sp = pos; | 
|  | 2013 | sp += sprintf(sp, "%d: uart:%s ", portnr, uart); | 
|  | 2014 |  | 
|  | 2015 | if ((brdp->state & BST_STARTED) && (rc >= 0)) { | 
|  | 2016 | sp += sprintf(sp, "tx:%d rx:%d", (int) stli_comstats.txtotal, | 
|  | 2017 | (int) stli_comstats.rxtotal); | 
|  | 2018 |  | 
|  | 2019 | if (stli_comstats.rxframing) | 
|  | 2020 | sp += sprintf(sp, " fe:%d", | 
|  | 2021 | (int) stli_comstats.rxframing); | 
|  | 2022 | if (stli_comstats.rxparity) | 
|  | 2023 | sp += sprintf(sp, " pe:%d", | 
|  | 2024 | (int) stli_comstats.rxparity); | 
|  | 2025 | if (stli_comstats.rxbreaks) | 
|  | 2026 | sp += sprintf(sp, " brk:%d", | 
|  | 2027 | (int) stli_comstats.rxbreaks); | 
|  | 2028 | if (stli_comstats.rxoverrun) | 
|  | 2029 | sp += sprintf(sp, " oe:%d", | 
|  | 2030 | (int) stli_comstats.rxoverrun); | 
|  | 2031 |  | 
|  | 2032 | cnt = sprintf(sp, "%s%s%s%s%s ", | 
|  | 2033 | (stli_comstats.signals & TIOCM_RTS) ? "|RTS" : "", | 
|  | 2034 | (stli_comstats.signals & TIOCM_CTS) ? "|CTS" : "", | 
|  | 2035 | (stli_comstats.signals & TIOCM_DTR) ? "|DTR" : "", | 
|  | 2036 | (stli_comstats.signals & TIOCM_CD) ? "|DCD" : "", | 
|  | 2037 | (stli_comstats.signals & TIOCM_DSR) ? "|DSR" : ""); | 
|  | 2038 | *sp = ' '; | 
|  | 2039 | sp += cnt; | 
|  | 2040 | } | 
|  | 2041 |  | 
|  | 2042 | for (cnt = (sp - pos); (cnt < (MAXLINE - 1)); cnt++) | 
|  | 2043 | *sp++ = ' '; | 
|  | 2044 | if (cnt >= MAXLINE) | 
|  | 2045 | pos[(MAXLINE - 2)] = '+'; | 
|  | 2046 | pos[(MAXLINE - 1)] = '\n'; | 
|  | 2047 |  | 
|  | 2048 | return(MAXLINE); | 
|  | 2049 | } | 
|  | 2050 |  | 
|  | 2051 | /*****************************************************************************/ | 
|  | 2052 |  | 
|  | 2053 | /* | 
|  | 2054 | *	Port info, read from the /proc file system. | 
|  | 2055 | */ | 
|  | 2056 |  | 
|  | 2057 | static int stli_readproc(char *page, char **start, off_t off, int count, int *eof, void *data) | 
|  | 2058 | { | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 2059 | struct stlibrd *brdp; | 
|  | 2060 | struct stliport *portp; | 
| Jiri Slaby | 1328d73 | 2006-12-08 02:39:19 -0800 | [diff] [blame] | 2061 | unsigned int brdnr, portnr, totalport; | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 2062 | int curoff, maxoff; | 
|  | 2063 | char *pos; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2064 |  | 
|  | 2065 | pos = page; | 
|  | 2066 | totalport = 0; | 
|  | 2067 | curoff = 0; | 
|  | 2068 |  | 
|  | 2069 | if (off == 0) { | 
|  | 2070 | pos += sprintf(pos, "%s: version %s", stli_drvtitle, | 
|  | 2071 | stli_drvversion); | 
|  | 2072 | while (pos < (page + MAXLINE - 1)) | 
|  | 2073 | *pos++ = ' '; | 
|  | 2074 | *pos++ = '\n'; | 
|  | 2075 | } | 
|  | 2076 | curoff =  MAXLINE; | 
|  | 2077 |  | 
|  | 2078 | /* | 
|  | 2079 | *	We scan through for each board, panel and port. The offset is | 
|  | 2080 | *	calculated on the fly, and irrelevant ports are skipped. | 
|  | 2081 | */ | 
|  | 2082 | for (brdnr = 0; (brdnr < stli_nrbrds); brdnr++) { | 
|  | 2083 | brdp = stli_brds[brdnr]; | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 2084 | if (brdp == NULL) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2085 | continue; | 
|  | 2086 | if (brdp->state == 0) | 
|  | 2087 | continue; | 
|  | 2088 |  | 
|  | 2089 | maxoff = curoff + (brdp->nrports * MAXLINE); | 
|  | 2090 | if (off >= maxoff) { | 
|  | 2091 | curoff = maxoff; | 
|  | 2092 | continue; | 
|  | 2093 | } | 
|  | 2094 |  | 
|  | 2095 | totalport = brdnr * STL_MAXPORTS; | 
|  | 2096 | for (portnr = 0; (portnr < brdp->nrports); portnr++, | 
|  | 2097 | totalport++) { | 
|  | 2098 | portp = brdp->ports[portnr]; | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 2099 | if (portp == NULL) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2100 | continue; | 
|  | 2101 | if (off >= (curoff += MAXLINE)) | 
|  | 2102 | continue; | 
|  | 2103 | if ((pos - page + MAXLINE) > count) | 
|  | 2104 | goto stli_readdone; | 
|  | 2105 | pos += stli_portinfo(brdp, portp, totalport, pos); | 
|  | 2106 | } | 
|  | 2107 | } | 
|  | 2108 |  | 
|  | 2109 | *eof = 1; | 
|  | 2110 |  | 
|  | 2111 | stli_readdone: | 
|  | 2112 | *start = page; | 
|  | 2113 | return(pos - page); | 
|  | 2114 | } | 
|  | 2115 |  | 
|  | 2116 | /*****************************************************************************/ | 
|  | 2117 |  | 
|  | 2118 | /* | 
|  | 2119 | *	Generic send command routine. This will send a message to the slave, | 
|  | 2120 | *	of the specified type with the specified argument. Must be very | 
|  | 2121 | *	careful of data that will be copied out from shared memory - | 
|  | 2122 | *	containing command results. The command completion is all done from | 
|  | 2123 | *	a poll routine that does not have user context. Therefore you cannot | 
|  | 2124 | *	copy back directly into user space, or to the kernel stack of a | 
|  | 2125 | *	process. This routine does not sleep, so can be called from anywhere. | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 2126 | * | 
|  | 2127 | *	The caller must hold the brd_lock (see also stli_sendcmd the usual | 
|  | 2128 | *	entry point) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2129 | */ | 
|  | 2130 |  | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 2131 | static void __stli_sendcmd(struct stlibrd *brdp, struct stliport *portp, unsigned long cmd, void *arg, int size, int copyback) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2132 | { | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 2133 | cdkhdr_t __iomem *hdrp; | 
|  | 2134 | cdkctrl_t __iomem *cp; | 
|  | 2135 | unsigned char __iomem *bits; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2136 |  | 
|  | 2137 | if (test_bit(ST_CMDING, &portp->state)) { | 
|  | 2138 | printk(KERN_ERR "STALLION: command already busy, cmd=%x!\n", | 
|  | 2139 | (int) cmd); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2140 | return; | 
|  | 2141 | } | 
|  | 2142 |  | 
|  | 2143 | EBRDENABLE(brdp); | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 2144 | cp = &((cdkasy_t __iomem *) EBRDGETMEMPTR(brdp, portp->addr))->ctrl; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2145 | if (size > 0) { | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 2146 | memcpy_toio((void __iomem *) &(cp->args[0]), arg, size); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2147 | if (copyback) { | 
|  | 2148 | portp->argp = arg; | 
|  | 2149 | portp->argsize = size; | 
|  | 2150 | } | 
|  | 2151 | } | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 2152 | writel(0, &cp->status); | 
|  | 2153 | writel(cmd, &cp->cmd); | 
|  | 2154 | hdrp = (cdkhdr_t __iomem *) EBRDGETMEMPTR(brdp, CDK_CDKADDR); | 
|  | 2155 | bits = ((unsigned char __iomem *) hdrp) + brdp->slaveoffset + | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2156 | portp->portidx; | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 2157 | writeb(readb(bits) | portp->portbit, bits); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2158 | set_bit(ST_CMDING, &portp->state); | 
|  | 2159 | EBRDDISABLE(brdp); | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 2160 | } | 
|  | 2161 |  | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 2162 | static void stli_sendcmd(struct stlibrd *brdp, struct stliport *portp, unsigned long cmd, void *arg, int size, int copyback) | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 2163 | { | 
|  | 2164 | unsigned long		flags; | 
|  | 2165 |  | 
|  | 2166 | spin_lock_irqsave(&brd_lock, flags); | 
|  | 2167 | __stli_sendcmd(brdp, portp, cmd, arg, size, copyback); | 
|  | 2168 | spin_unlock_irqrestore(&brd_lock, flags); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2169 | } | 
|  | 2170 |  | 
|  | 2171 | /*****************************************************************************/ | 
|  | 2172 |  | 
|  | 2173 | /* | 
|  | 2174 | *	Read data from shared memory. This assumes that the shared memory | 
|  | 2175 | *	is enabled and that interrupts are off. Basically we just empty out | 
|  | 2176 | *	the shared memory buffer into the tty buffer. Must be careful to | 
|  | 2177 | *	handle the case where we fill up the tty buffer, but still have | 
|  | 2178 | *	more chars to unload. | 
|  | 2179 | */ | 
|  | 2180 |  | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 2181 | static void stli_read(struct stlibrd *brdp, struct stliport *portp) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2182 | { | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 2183 | cdkasyrq_t __iomem *rp; | 
|  | 2184 | char __iomem *shbuf; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2185 | struct tty_struct	*tty; | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 2186 | unsigned int head, tail, size; | 
|  | 2187 | unsigned int len, stlen; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2188 |  | 
|  | 2189 | if (test_bit(ST_RXSTOP, &portp->state)) | 
|  | 2190 | return; | 
|  | 2191 | tty = portp->tty; | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 2192 | if (tty == NULL) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2193 | return; | 
|  | 2194 |  | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 2195 | rp = &((cdkasy_t __iomem *) EBRDGETMEMPTR(brdp, portp->addr))->rxq; | 
|  | 2196 | head = (unsigned int) readw(&rp->head); | 
|  | 2197 | if (head != ((unsigned int) readw(&rp->head))) | 
|  | 2198 | head = (unsigned int) readw(&rp->head); | 
|  | 2199 | tail = (unsigned int) readw(&rp->tail); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2200 | size = portp->rxsize; | 
|  | 2201 | if (head >= tail) { | 
|  | 2202 | len = head - tail; | 
|  | 2203 | stlen = len; | 
|  | 2204 | } else { | 
|  | 2205 | len = size - (tail - head); | 
|  | 2206 | stlen = size - tail; | 
|  | 2207 | } | 
|  | 2208 |  | 
| Alan Cox | 33f0f88 | 2006-01-09 20:54:13 -0800 | [diff] [blame] | 2209 | len = tty_buffer_request_room(tty, len); | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 2210 |  | 
|  | 2211 | shbuf = (char __iomem *) EBRDGETMEMPTR(brdp, portp->rxoffset); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2212 |  | 
|  | 2213 | while (len > 0) { | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 2214 | unsigned char *cptr; | 
|  | 2215 |  | 
| Jiri Slaby | a3f8d9d | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 2216 | stlen = min(len, stlen); | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 2217 | tty_prepare_flip_string(tty, &cptr, stlen); | 
|  | 2218 | memcpy_fromio(cptr, shbuf + tail, stlen); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2219 | len -= stlen; | 
|  | 2220 | tail += stlen; | 
|  | 2221 | if (tail >= size) { | 
|  | 2222 | tail = 0; | 
|  | 2223 | stlen = head; | 
|  | 2224 | } | 
|  | 2225 | } | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 2226 | rp = &((cdkasy_t __iomem *) EBRDGETMEMPTR(brdp, portp->addr))->rxq; | 
|  | 2227 | writew(tail, &rp->tail); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2228 |  | 
|  | 2229 | if (head != tail) | 
|  | 2230 | set_bit(ST_RXING, &portp->state); | 
|  | 2231 |  | 
|  | 2232 | tty_schedule_flip(tty); | 
|  | 2233 | } | 
|  | 2234 |  | 
|  | 2235 | /*****************************************************************************/ | 
|  | 2236 |  | 
|  | 2237 | /* | 
|  | 2238 | *	Set up and carry out any delayed commands. There is only a small set | 
|  | 2239 | *	of slave commands that can be done "off-level". So it is not too | 
|  | 2240 | *	difficult to deal with them here. | 
|  | 2241 | */ | 
|  | 2242 |  | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 2243 | static void stli_dodelaycmd(struct stliport *portp, cdkctrl_t __iomem *cp) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2244 | { | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 2245 | int cmd; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2246 |  | 
|  | 2247 | if (test_bit(ST_DOSIGS, &portp->state)) { | 
|  | 2248 | if (test_bit(ST_DOFLUSHTX, &portp->state) && | 
|  | 2249 | test_bit(ST_DOFLUSHRX, &portp->state)) | 
|  | 2250 | cmd = A_SETSIGNALSF; | 
|  | 2251 | else if (test_bit(ST_DOFLUSHTX, &portp->state)) | 
|  | 2252 | cmd = A_SETSIGNALSFTX; | 
|  | 2253 | else if (test_bit(ST_DOFLUSHRX, &portp->state)) | 
|  | 2254 | cmd = A_SETSIGNALSFRX; | 
|  | 2255 | else | 
|  | 2256 | cmd = A_SETSIGNALS; | 
|  | 2257 | clear_bit(ST_DOFLUSHTX, &portp->state); | 
|  | 2258 | clear_bit(ST_DOFLUSHRX, &portp->state); | 
|  | 2259 | clear_bit(ST_DOSIGS, &portp->state); | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 2260 | memcpy_toio((void __iomem *) &(cp->args[0]), (void *) &portp->asig, | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2261 | sizeof(asysigs_t)); | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 2262 | writel(0, &cp->status); | 
|  | 2263 | writel(cmd, &cp->cmd); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2264 | set_bit(ST_CMDING, &portp->state); | 
|  | 2265 | } else if (test_bit(ST_DOFLUSHTX, &portp->state) || | 
|  | 2266 | test_bit(ST_DOFLUSHRX, &portp->state)) { | 
|  | 2267 | cmd = ((test_bit(ST_DOFLUSHTX, &portp->state)) ? FLUSHTX : 0); | 
|  | 2268 | cmd |= ((test_bit(ST_DOFLUSHRX, &portp->state)) ? FLUSHRX : 0); | 
|  | 2269 | clear_bit(ST_DOFLUSHTX, &portp->state); | 
|  | 2270 | clear_bit(ST_DOFLUSHRX, &portp->state); | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 2271 | memcpy_toio((void __iomem *) &(cp->args[0]), (void *) &cmd, sizeof(int)); | 
|  | 2272 | writel(0, &cp->status); | 
|  | 2273 | writel(A_FLUSH, &cp->cmd); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2274 | set_bit(ST_CMDING, &portp->state); | 
|  | 2275 | } | 
|  | 2276 | } | 
|  | 2277 |  | 
|  | 2278 | /*****************************************************************************/ | 
|  | 2279 |  | 
|  | 2280 | /* | 
|  | 2281 | *	Host command service checking. This handles commands or messages | 
|  | 2282 | *	coming from the slave to the host. Must have board shared memory | 
|  | 2283 | *	enabled and interrupts off when called. Notice that by servicing the | 
|  | 2284 | *	read data last we don't need to change the shared memory pointer | 
|  | 2285 | *	during processing (which is a slow IO operation). | 
|  | 2286 | *	Return value indicates if this port is still awaiting actions from | 
|  | 2287 | *	the slave (like open, command, or even TX data being sent). If 0 | 
|  | 2288 | *	then port is still busy, otherwise no longer busy. | 
|  | 2289 | */ | 
|  | 2290 |  | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 2291 | static int stli_hostcmd(struct stlibrd *brdp, struct stliport *portp) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2292 | { | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 2293 | cdkasy_t __iomem *ap; | 
|  | 2294 | cdkctrl_t __iomem *cp; | 
|  | 2295 | struct tty_struct *tty; | 
|  | 2296 | asynotify_t nt; | 
|  | 2297 | unsigned long oldsigs; | 
|  | 2298 | int rc, donerx; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2299 |  | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 2300 | ap = (cdkasy_t __iomem *) EBRDGETMEMPTR(brdp, portp->addr); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2301 | cp = &ap->ctrl; | 
|  | 2302 |  | 
|  | 2303 | /* | 
|  | 2304 | *	Check if we are waiting for an open completion message. | 
|  | 2305 | */ | 
|  | 2306 | if (test_bit(ST_OPENING, &portp->state)) { | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 2307 | rc = readl(&cp->openarg); | 
|  | 2308 | if (readb(&cp->open) == 0 && rc != 0) { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2309 | if (rc > 0) | 
|  | 2310 | rc--; | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 2311 | writel(0, &cp->openarg); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2312 | portp->rc = rc; | 
|  | 2313 | clear_bit(ST_OPENING, &portp->state); | 
|  | 2314 | wake_up_interruptible(&portp->raw_wait); | 
|  | 2315 | } | 
|  | 2316 | } | 
|  | 2317 |  | 
|  | 2318 | /* | 
|  | 2319 | *	Check if we are waiting for a close completion message. | 
|  | 2320 | */ | 
|  | 2321 | if (test_bit(ST_CLOSING, &portp->state)) { | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 2322 | rc = (int) readl(&cp->closearg); | 
|  | 2323 | if (readb(&cp->close) == 0 && rc != 0) { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2324 | if (rc > 0) | 
|  | 2325 | rc--; | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 2326 | writel(0, &cp->closearg); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2327 | portp->rc = rc; | 
|  | 2328 | clear_bit(ST_CLOSING, &portp->state); | 
|  | 2329 | wake_up_interruptible(&portp->raw_wait); | 
|  | 2330 | } | 
|  | 2331 | } | 
|  | 2332 |  | 
|  | 2333 | /* | 
|  | 2334 | *	Check if we are waiting for a command completion message. We may | 
|  | 2335 | *	need to copy out the command results associated with this command. | 
|  | 2336 | */ | 
|  | 2337 | if (test_bit(ST_CMDING, &portp->state)) { | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 2338 | rc = readl(&cp->status); | 
|  | 2339 | if (readl(&cp->cmd) == 0 && rc != 0) { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2340 | if (rc > 0) | 
|  | 2341 | rc--; | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 2342 | if (portp->argp != NULL) { | 
|  | 2343 | memcpy_fromio(portp->argp, (void __iomem *) &(cp->args[0]), | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2344 | portp->argsize); | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 2345 | portp->argp = NULL; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2346 | } | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 2347 | writel(0, &cp->status); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2348 | portp->rc = rc; | 
|  | 2349 | clear_bit(ST_CMDING, &portp->state); | 
|  | 2350 | stli_dodelaycmd(portp, cp); | 
|  | 2351 | wake_up_interruptible(&portp->raw_wait); | 
|  | 2352 | } | 
|  | 2353 | } | 
|  | 2354 |  | 
|  | 2355 | /* | 
|  | 2356 | *	Check for any notification messages ready. This includes lots of | 
|  | 2357 | *	different types of events - RX chars ready, RX break received, | 
|  | 2358 | *	TX data low or empty in the slave, modem signals changed state. | 
|  | 2359 | */ | 
|  | 2360 | donerx = 0; | 
|  | 2361 |  | 
|  | 2362 | if (ap->notify) { | 
|  | 2363 | nt = ap->changed; | 
|  | 2364 | ap->notify = 0; | 
|  | 2365 | tty = portp->tty; | 
|  | 2366 |  | 
|  | 2367 | if (nt.signal & SG_DCD) { | 
|  | 2368 | oldsigs = portp->sigs; | 
|  | 2369 | portp->sigs = stli_mktiocm(nt.sigvalue); | 
|  | 2370 | clear_bit(ST_GETSIGS, &portp->state); | 
|  | 2371 | if ((portp->sigs & TIOCM_CD) && | 
|  | 2372 | ((oldsigs & TIOCM_CD) == 0)) | 
|  | 2373 | wake_up_interruptible(&portp->open_wait); | 
|  | 2374 | if ((oldsigs & TIOCM_CD) && | 
|  | 2375 | ((portp->sigs & TIOCM_CD) == 0)) { | 
|  | 2376 | if (portp->flags & ASYNC_CHECK_CD) { | 
|  | 2377 | if (tty) | 
| Jiri Slaby | cfccaee | 2008-02-07 00:16:38 -0800 | [diff] [blame] | 2378 | tty_hangup(tty); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2379 | } | 
|  | 2380 | } | 
|  | 2381 | } | 
|  | 2382 |  | 
|  | 2383 | if (nt.data & DT_TXEMPTY) | 
|  | 2384 | clear_bit(ST_TXBUSY, &portp->state); | 
|  | 2385 | if (nt.data & (DT_TXEMPTY | DT_TXLOW)) { | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 2386 | if (tty != NULL) { | 
|  | 2387 | tty_wakeup(tty); | 
|  | 2388 | EBRDENABLE(brdp); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2389 | } | 
|  | 2390 | } | 
|  | 2391 |  | 
|  | 2392 | if ((nt.data & DT_RXBREAK) && (portp->rxmarkmsk & BRKINT)) { | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 2393 | if (tty != NULL) { | 
| Alan Cox | 33f0f88 | 2006-01-09 20:54:13 -0800 | [diff] [blame] | 2394 | tty_insert_flip_char(tty, 0, TTY_BREAK); | 
|  | 2395 | if (portp->flags & ASYNC_SAK) { | 
|  | 2396 | do_SAK(tty); | 
|  | 2397 | EBRDENABLE(brdp); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2398 | } | 
| Alan Cox | 33f0f88 | 2006-01-09 20:54:13 -0800 | [diff] [blame] | 2399 | tty_schedule_flip(tty); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2400 | } | 
|  | 2401 | } | 
|  | 2402 |  | 
|  | 2403 | if (nt.data & DT_RXBUSY) { | 
|  | 2404 | donerx++; | 
|  | 2405 | stli_read(brdp, portp); | 
|  | 2406 | } | 
|  | 2407 | } | 
|  | 2408 |  | 
|  | 2409 | /* | 
|  | 2410 | *	It might seem odd that we are checking for more RX chars here. | 
|  | 2411 | *	But, we need to handle the case where the tty buffer was previously | 
|  | 2412 | *	filled, but we had more characters to pass up. The slave will not | 
|  | 2413 | *	send any more RX notify messages until the RX buffer has been emptied. | 
|  | 2414 | *	But it will leave the service bits on (since the buffer is not empty). | 
|  | 2415 | *	So from here we can try to process more RX chars. | 
|  | 2416 | */ | 
|  | 2417 | if ((!donerx) && test_bit(ST_RXING, &portp->state)) { | 
|  | 2418 | clear_bit(ST_RXING, &portp->state); | 
|  | 2419 | stli_read(brdp, portp); | 
|  | 2420 | } | 
|  | 2421 |  | 
|  | 2422 | return((test_bit(ST_OPENING, &portp->state) || | 
|  | 2423 | test_bit(ST_CLOSING, &portp->state) || | 
|  | 2424 | test_bit(ST_CMDING, &portp->state) || | 
|  | 2425 | test_bit(ST_TXBUSY, &portp->state) || | 
|  | 2426 | test_bit(ST_RXING, &portp->state)) ? 0 : 1); | 
|  | 2427 | } | 
|  | 2428 |  | 
|  | 2429 | /*****************************************************************************/ | 
|  | 2430 |  | 
|  | 2431 | /* | 
|  | 2432 | *	Service all ports on a particular board. Assumes that the boards | 
|  | 2433 | *	shared memory is enabled, and that the page pointer is pointed | 
|  | 2434 | *	at the cdk header structure. | 
|  | 2435 | */ | 
|  | 2436 |  | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 2437 | static void stli_brdpoll(struct stlibrd *brdp, cdkhdr_t __iomem *hdrp) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2438 | { | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 2439 | struct stliport *portp; | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 2440 | unsigned char hostbits[(STL_MAXCHANS / 8) + 1]; | 
|  | 2441 | unsigned char slavebits[(STL_MAXCHANS / 8) + 1]; | 
|  | 2442 | unsigned char __iomem *slavep; | 
|  | 2443 | int bitpos, bitat, bitsize; | 
|  | 2444 | int channr, nrdevs, slavebitchange; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2445 |  | 
|  | 2446 | bitsize = brdp->bitsize; | 
|  | 2447 | nrdevs = brdp->nrdevs; | 
|  | 2448 |  | 
|  | 2449 | /* | 
|  | 2450 | *	Check if slave wants any service. Basically we try to do as | 
|  | 2451 | *	little work as possible here. There are 2 levels of service | 
|  | 2452 | *	bits. So if there is nothing to do we bail early. We check | 
|  | 2453 | *	8 service bits at a time in the inner loop, so we can bypass | 
|  | 2454 | *	the lot if none of them want service. | 
|  | 2455 | */ | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 2456 | memcpy_fromio(&hostbits[0], (((unsigned char __iomem *) hdrp) + brdp->hostoffset), | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2457 | bitsize); | 
|  | 2458 |  | 
|  | 2459 | memset(&slavebits[0], 0, bitsize); | 
|  | 2460 | slavebitchange = 0; | 
|  | 2461 |  | 
|  | 2462 | for (bitpos = 0; (bitpos < bitsize); bitpos++) { | 
|  | 2463 | if (hostbits[bitpos] == 0) | 
|  | 2464 | continue; | 
|  | 2465 | channr = bitpos * 8; | 
|  | 2466 | for (bitat = 0x1; (channr < nrdevs); channr++, bitat <<= 1) { | 
|  | 2467 | if (hostbits[bitpos] & bitat) { | 
|  | 2468 | portp = brdp->ports[(channr - 1)]; | 
|  | 2469 | if (stli_hostcmd(brdp, portp)) { | 
|  | 2470 | slavebitchange++; | 
|  | 2471 | slavebits[bitpos] |= bitat; | 
|  | 2472 | } | 
|  | 2473 | } | 
|  | 2474 | } | 
|  | 2475 | } | 
|  | 2476 |  | 
|  | 2477 | /* | 
|  | 2478 | *	If any of the ports are no longer busy then update them in the | 
|  | 2479 | *	slave request bits. We need to do this after, since a host port | 
|  | 2480 | *	service may initiate more slave requests. | 
|  | 2481 | */ | 
|  | 2482 | if (slavebitchange) { | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 2483 | hdrp = (cdkhdr_t __iomem *) EBRDGETMEMPTR(brdp, CDK_CDKADDR); | 
|  | 2484 | slavep = ((unsigned char __iomem *) hdrp) + brdp->slaveoffset; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2485 | for (bitpos = 0; (bitpos < bitsize); bitpos++) { | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 2486 | if (readb(slavebits + bitpos)) | 
|  | 2487 | writeb(readb(slavep + bitpos) & ~slavebits[bitpos], slavebits + bitpos); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2488 | } | 
|  | 2489 | } | 
|  | 2490 | } | 
|  | 2491 |  | 
|  | 2492 | /*****************************************************************************/ | 
|  | 2493 |  | 
|  | 2494 | /* | 
|  | 2495 | *	Driver poll routine. This routine polls the boards in use and passes | 
|  | 2496 | *	messages back up to host when necessary. This is actually very | 
|  | 2497 | *	CPU efficient, since we will always have the kernel poll clock, it | 
|  | 2498 | *	adds only a few cycles when idle (since board service can be | 
|  | 2499 | *	determined very easily), but when loaded generates no interrupts | 
|  | 2500 | *	(with their expensive associated context change). | 
|  | 2501 | */ | 
|  | 2502 |  | 
|  | 2503 | static void stli_poll(unsigned long arg) | 
|  | 2504 | { | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 2505 | cdkhdr_t __iomem *hdrp; | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 2506 | struct stlibrd *brdp; | 
| Jiri Slaby | 1328d73 | 2006-12-08 02:39:19 -0800 | [diff] [blame] | 2507 | unsigned int brdnr; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2508 |  | 
| Jiri Slaby | ff8efe9 | 2006-12-08 02:39:27 -0800 | [diff] [blame] | 2509 | mod_timer(&stli_timerlist, STLI_TIMEOUT); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2510 |  | 
|  | 2511 | /* | 
|  | 2512 | *	Check each board and do any servicing required. | 
|  | 2513 | */ | 
|  | 2514 | for (brdnr = 0; (brdnr < stli_nrbrds); brdnr++) { | 
|  | 2515 | brdp = stli_brds[brdnr]; | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 2516 | if (brdp == NULL) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2517 | continue; | 
|  | 2518 | if ((brdp->state & BST_STARTED) == 0) | 
|  | 2519 | continue; | 
|  | 2520 |  | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 2521 | spin_lock(&brd_lock); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2522 | EBRDENABLE(brdp); | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 2523 | hdrp = (cdkhdr_t __iomem *) EBRDGETMEMPTR(brdp, CDK_CDKADDR); | 
|  | 2524 | if (readb(&hdrp->hostreq)) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2525 | stli_brdpoll(brdp, hdrp); | 
|  | 2526 | EBRDDISABLE(brdp); | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 2527 | spin_unlock(&brd_lock); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2528 | } | 
|  | 2529 | } | 
|  | 2530 |  | 
|  | 2531 | /*****************************************************************************/ | 
|  | 2532 |  | 
|  | 2533 | /* | 
|  | 2534 | *	Translate the termios settings into the port setting structure of | 
|  | 2535 | *	the slave. | 
|  | 2536 | */ | 
|  | 2537 |  | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 2538 | static void stli_mkasyport(struct stliport *portp, asyport_t *pp, struct ktermios *tiosp) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2539 | { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2540 | memset(pp, 0, sizeof(asyport_t)); | 
|  | 2541 |  | 
|  | 2542 | /* | 
|  | 2543 | *	Start of by setting the baud, char size, parity and stop bit info. | 
|  | 2544 | */ | 
| Alan Cox | 1db27c1 | 2006-09-29 02:01:38 -0700 | [diff] [blame] | 2545 | pp->baudout = tty_get_baud_rate(portp->tty); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2546 | if ((tiosp->c_cflag & CBAUD) == B38400) { | 
|  | 2547 | if ((portp->flags & ASYNC_SPD_MASK) == ASYNC_SPD_HI) | 
|  | 2548 | pp->baudout = 57600; | 
|  | 2549 | else if ((portp->flags & ASYNC_SPD_MASK) == ASYNC_SPD_VHI) | 
|  | 2550 | pp->baudout = 115200; | 
|  | 2551 | else if ((portp->flags & ASYNC_SPD_MASK) == ASYNC_SPD_SHI) | 
|  | 2552 | pp->baudout = 230400; | 
|  | 2553 | else if ((portp->flags & ASYNC_SPD_MASK) == ASYNC_SPD_WARP) | 
|  | 2554 | pp->baudout = 460800; | 
|  | 2555 | else if ((portp->flags & ASYNC_SPD_MASK) == ASYNC_SPD_CUST) | 
|  | 2556 | pp->baudout = (portp->baud_base / portp->custom_divisor); | 
|  | 2557 | } | 
|  | 2558 | if (pp->baudout > STL_MAXBAUD) | 
|  | 2559 | pp->baudout = STL_MAXBAUD; | 
|  | 2560 | pp->baudin = pp->baudout; | 
|  | 2561 |  | 
|  | 2562 | switch (tiosp->c_cflag & CSIZE) { | 
|  | 2563 | case CS5: | 
|  | 2564 | pp->csize = 5; | 
|  | 2565 | break; | 
|  | 2566 | case CS6: | 
|  | 2567 | pp->csize = 6; | 
|  | 2568 | break; | 
|  | 2569 | case CS7: | 
|  | 2570 | pp->csize = 7; | 
|  | 2571 | break; | 
|  | 2572 | default: | 
|  | 2573 | pp->csize = 8; | 
|  | 2574 | break; | 
|  | 2575 | } | 
|  | 2576 |  | 
|  | 2577 | if (tiosp->c_cflag & CSTOPB) | 
|  | 2578 | pp->stopbs = PT_STOP2; | 
|  | 2579 | else | 
|  | 2580 | pp->stopbs = PT_STOP1; | 
|  | 2581 |  | 
|  | 2582 | if (tiosp->c_cflag & PARENB) { | 
|  | 2583 | if (tiosp->c_cflag & PARODD) | 
|  | 2584 | pp->parity = PT_ODDPARITY; | 
|  | 2585 | else | 
|  | 2586 | pp->parity = PT_EVENPARITY; | 
|  | 2587 | } else { | 
|  | 2588 | pp->parity = PT_NOPARITY; | 
|  | 2589 | } | 
|  | 2590 |  | 
|  | 2591 | /* | 
|  | 2592 | *	Set up any flow control options enabled. | 
|  | 2593 | */ | 
|  | 2594 | if (tiosp->c_iflag & IXON) { | 
|  | 2595 | pp->flow |= F_IXON; | 
|  | 2596 | if (tiosp->c_iflag & IXANY) | 
|  | 2597 | pp->flow |= F_IXANY; | 
|  | 2598 | } | 
|  | 2599 | if (tiosp->c_cflag & CRTSCTS) | 
|  | 2600 | pp->flow |= (F_RTSFLOW | F_CTSFLOW); | 
|  | 2601 |  | 
|  | 2602 | pp->startin = tiosp->c_cc[VSTART]; | 
|  | 2603 | pp->stopin = tiosp->c_cc[VSTOP]; | 
|  | 2604 | pp->startout = tiosp->c_cc[VSTART]; | 
|  | 2605 | pp->stopout = tiosp->c_cc[VSTOP]; | 
|  | 2606 |  | 
|  | 2607 | /* | 
|  | 2608 | *	Set up the RX char marking mask with those RX error types we must | 
|  | 2609 | *	catch. We can get the slave to help us out a little here, it will | 
|  | 2610 | *	ignore parity errors and breaks for us, and mark parity errors in | 
|  | 2611 | *	the data stream. | 
|  | 2612 | */ | 
|  | 2613 | if (tiosp->c_iflag & IGNPAR) | 
|  | 2614 | pp->iflag |= FI_IGNRXERRS; | 
|  | 2615 | if (tiosp->c_iflag & IGNBRK) | 
|  | 2616 | pp->iflag |= FI_IGNBREAK; | 
|  | 2617 |  | 
|  | 2618 | portp->rxmarkmsk = 0; | 
|  | 2619 | if (tiosp->c_iflag & (INPCK | PARMRK)) | 
|  | 2620 | pp->iflag |= FI_1MARKRXERRS; | 
|  | 2621 | if (tiosp->c_iflag & BRKINT) | 
|  | 2622 | portp->rxmarkmsk |= BRKINT; | 
|  | 2623 |  | 
|  | 2624 | /* | 
|  | 2625 | *	Set up clocal processing as required. | 
|  | 2626 | */ | 
|  | 2627 | if (tiosp->c_cflag & CLOCAL) | 
|  | 2628 | portp->flags &= ~ASYNC_CHECK_CD; | 
|  | 2629 | else | 
|  | 2630 | portp->flags |= ASYNC_CHECK_CD; | 
|  | 2631 |  | 
|  | 2632 | /* | 
|  | 2633 | *	Transfer any persistent flags into the asyport structure. | 
|  | 2634 | */ | 
|  | 2635 | pp->pflag = (portp->pflag & 0xffff); | 
|  | 2636 | pp->vmin = (portp->pflag & P_RXIMIN) ? 1 : 0; | 
|  | 2637 | pp->vtime = (portp->pflag & P_RXITIME) ? 1 : 0; | 
|  | 2638 | pp->cc[1] = (portp->pflag & P_RXTHOLD) ? 1 : 0; | 
|  | 2639 | } | 
|  | 2640 |  | 
|  | 2641 | /*****************************************************************************/ | 
|  | 2642 |  | 
|  | 2643 | /* | 
|  | 2644 | *	Construct a slave signals structure for setting the DTR and RTS | 
|  | 2645 | *	signals as specified. | 
|  | 2646 | */ | 
|  | 2647 |  | 
|  | 2648 | static void stli_mkasysigs(asysigs_t *sp, int dtr, int rts) | 
|  | 2649 | { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2650 | memset(sp, 0, sizeof(asysigs_t)); | 
|  | 2651 | if (dtr >= 0) { | 
|  | 2652 | sp->signal |= SG_DTR; | 
|  | 2653 | sp->sigvalue |= ((dtr > 0) ? SG_DTR : 0); | 
|  | 2654 | } | 
|  | 2655 | if (rts >= 0) { | 
|  | 2656 | sp->signal |= SG_RTS; | 
|  | 2657 | sp->sigvalue |= ((rts > 0) ? SG_RTS : 0); | 
|  | 2658 | } | 
|  | 2659 | } | 
|  | 2660 |  | 
|  | 2661 | /*****************************************************************************/ | 
|  | 2662 |  | 
|  | 2663 | /* | 
|  | 2664 | *	Convert the signals returned from the slave into a local TIOCM type | 
|  | 2665 | *	signals value. We keep them locally in TIOCM format. | 
|  | 2666 | */ | 
|  | 2667 |  | 
|  | 2668 | static long stli_mktiocm(unsigned long sigvalue) | 
|  | 2669 | { | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 2670 | long	tiocm = 0; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2671 | tiocm |= ((sigvalue & SG_DCD) ? TIOCM_CD : 0); | 
|  | 2672 | tiocm |= ((sigvalue & SG_CTS) ? TIOCM_CTS : 0); | 
|  | 2673 | tiocm |= ((sigvalue & SG_RI) ? TIOCM_RI : 0); | 
|  | 2674 | tiocm |= ((sigvalue & SG_DSR) ? TIOCM_DSR : 0); | 
|  | 2675 | tiocm |= ((sigvalue & SG_DTR) ? TIOCM_DTR : 0); | 
|  | 2676 | tiocm |= ((sigvalue & SG_RTS) ? TIOCM_RTS : 0); | 
|  | 2677 | return(tiocm); | 
|  | 2678 | } | 
|  | 2679 |  | 
|  | 2680 | /*****************************************************************************/ | 
|  | 2681 |  | 
|  | 2682 | /* | 
|  | 2683 | *	All panels and ports actually attached have been worked out. All | 
|  | 2684 | *	we need to do here is set up the appropriate per port data structures. | 
|  | 2685 | */ | 
|  | 2686 |  | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 2687 | static int stli_initports(struct stlibrd *brdp) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2688 | { | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 2689 | struct stliport	*portp; | 
| Jiri Slaby | 1328d73 | 2006-12-08 02:39:19 -0800 | [diff] [blame] | 2690 | unsigned int i, panelnr, panelport; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2691 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2692 | for (i = 0, panelnr = 0, panelport = 0; (i < brdp->nrports); i++) { | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 2693 | portp = kzalloc(sizeof(struct stliport), GFP_KERNEL); | 
| Tobias Klauser | b0b4ed7 | 2006-03-31 02:30:56 -0800 | [diff] [blame] | 2694 | if (!portp) { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2695 | printk("STALLION: failed to allocate port structure\n"); | 
|  | 2696 | continue; | 
|  | 2697 | } | 
|  | 2698 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2699 | portp->magic = STLI_PORTMAGIC; | 
|  | 2700 | portp->portnr = i; | 
|  | 2701 | portp->brdnr = brdp->brdnr; | 
|  | 2702 | portp->panelnr = panelnr; | 
|  | 2703 | portp->baud_base = STL_BAUDBASE; | 
|  | 2704 | portp->close_delay = STL_CLOSEDELAY; | 
|  | 2705 | portp->closing_wait = 30 * HZ; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2706 | init_waitqueue_head(&portp->open_wait); | 
|  | 2707 | init_waitqueue_head(&portp->close_wait); | 
|  | 2708 | init_waitqueue_head(&portp->raw_wait); | 
|  | 2709 | panelport++; | 
|  | 2710 | if (panelport >= brdp->panels[panelnr]) { | 
|  | 2711 | panelport = 0; | 
|  | 2712 | panelnr++; | 
|  | 2713 | } | 
|  | 2714 | brdp->ports[i] = portp; | 
|  | 2715 | } | 
|  | 2716 |  | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 2717 | return 0; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2718 | } | 
|  | 2719 |  | 
|  | 2720 | /*****************************************************************************/ | 
|  | 2721 |  | 
|  | 2722 | /* | 
|  | 2723 | *	All the following routines are board specific hardware operations. | 
|  | 2724 | */ | 
|  | 2725 |  | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 2726 | static void stli_ecpinit(struct stlibrd *brdp) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2727 | { | 
|  | 2728 | unsigned long	memconf; | 
|  | 2729 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2730 | outb(ECP_ATSTOP, (brdp->iobase + ECP_ATCONFR)); | 
|  | 2731 | udelay(10); | 
|  | 2732 | outb(ECP_ATDISABLE, (brdp->iobase + ECP_ATCONFR)); | 
|  | 2733 | udelay(100); | 
|  | 2734 |  | 
|  | 2735 | memconf = (brdp->memaddr & ECP_ATADDRMASK) >> ECP_ATADDRSHFT; | 
|  | 2736 | outb(memconf, (brdp->iobase + ECP_ATMEMAR)); | 
|  | 2737 | } | 
|  | 2738 |  | 
|  | 2739 | /*****************************************************************************/ | 
|  | 2740 |  | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 2741 | static void stli_ecpenable(struct stlibrd *brdp) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2742 | { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2743 | outb(ECP_ATENABLE, (brdp->iobase + ECP_ATCONFR)); | 
|  | 2744 | } | 
|  | 2745 |  | 
|  | 2746 | /*****************************************************************************/ | 
|  | 2747 |  | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 2748 | static void stli_ecpdisable(struct stlibrd *brdp) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2749 | { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2750 | outb(ECP_ATDISABLE, (brdp->iobase + ECP_ATCONFR)); | 
|  | 2751 | } | 
|  | 2752 |  | 
|  | 2753 | /*****************************************************************************/ | 
|  | 2754 |  | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 2755 | static void __iomem *stli_ecpgetmemptr(struct stlibrd *brdp, unsigned long offset, int line) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2756 | { | 
| Al Viro | 29756fa | 2006-10-10 22:47:27 +0100 | [diff] [blame] | 2757 | void __iomem *ptr; | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 2758 | unsigned char val; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2759 |  | 
|  | 2760 | if (offset > brdp->memsize) { | 
|  | 2761 | printk(KERN_ERR "STALLION: shared memory pointer=%x out of " | 
|  | 2762 | "range at line=%d(%d), brd=%d\n", | 
|  | 2763 | (int) offset, line, __LINE__, brdp->brdnr); | 
|  | 2764 | ptr = NULL; | 
|  | 2765 | val = 0; | 
|  | 2766 | } else { | 
|  | 2767 | ptr = brdp->membase + (offset % ECP_ATPAGESIZE); | 
|  | 2768 | val = (unsigned char) (offset / ECP_ATPAGESIZE); | 
|  | 2769 | } | 
|  | 2770 | outb(val, (brdp->iobase + ECP_ATMEMPR)); | 
|  | 2771 | return(ptr); | 
|  | 2772 | } | 
|  | 2773 |  | 
|  | 2774 | /*****************************************************************************/ | 
|  | 2775 |  | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 2776 | static void stli_ecpreset(struct stlibrd *brdp) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2777 | { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2778 | outb(ECP_ATSTOP, (brdp->iobase + ECP_ATCONFR)); | 
|  | 2779 | udelay(10); | 
|  | 2780 | outb(ECP_ATDISABLE, (brdp->iobase + ECP_ATCONFR)); | 
|  | 2781 | udelay(500); | 
|  | 2782 | } | 
|  | 2783 |  | 
|  | 2784 | /*****************************************************************************/ | 
|  | 2785 |  | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 2786 | static void stli_ecpintr(struct stlibrd *brdp) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2787 | { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2788 | outb(0x1, brdp->iobase); | 
|  | 2789 | } | 
|  | 2790 |  | 
|  | 2791 | /*****************************************************************************/ | 
|  | 2792 |  | 
|  | 2793 | /* | 
|  | 2794 | *	The following set of functions act on ECP EISA boards. | 
|  | 2795 | */ | 
|  | 2796 |  | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 2797 | static void stli_ecpeiinit(struct stlibrd *brdp) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2798 | { | 
|  | 2799 | unsigned long	memconf; | 
|  | 2800 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2801 | outb(0x1, (brdp->iobase + ECP_EIBRDENAB)); | 
|  | 2802 | outb(ECP_EISTOP, (brdp->iobase + ECP_EICONFR)); | 
|  | 2803 | udelay(10); | 
|  | 2804 | outb(ECP_EIDISABLE, (brdp->iobase + ECP_EICONFR)); | 
|  | 2805 | udelay(500); | 
|  | 2806 |  | 
|  | 2807 | memconf = (brdp->memaddr & ECP_EIADDRMASKL) >> ECP_EIADDRSHFTL; | 
|  | 2808 | outb(memconf, (brdp->iobase + ECP_EIMEMARL)); | 
|  | 2809 | memconf = (brdp->memaddr & ECP_EIADDRMASKH) >> ECP_EIADDRSHFTH; | 
|  | 2810 | outb(memconf, (brdp->iobase + ECP_EIMEMARH)); | 
|  | 2811 | } | 
|  | 2812 |  | 
|  | 2813 | /*****************************************************************************/ | 
|  | 2814 |  | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 2815 | static void stli_ecpeienable(struct stlibrd *brdp) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2816 | { | 
|  | 2817 | outb(ECP_EIENABLE, (brdp->iobase + ECP_EICONFR)); | 
|  | 2818 | } | 
|  | 2819 |  | 
|  | 2820 | /*****************************************************************************/ | 
|  | 2821 |  | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 2822 | static void stli_ecpeidisable(struct stlibrd *brdp) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2823 | { | 
|  | 2824 | outb(ECP_EIDISABLE, (brdp->iobase + ECP_EICONFR)); | 
|  | 2825 | } | 
|  | 2826 |  | 
|  | 2827 | /*****************************************************************************/ | 
|  | 2828 |  | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 2829 | static void __iomem *stli_ecpeigetmemptr(struct stlibrd *brdp, unsigned long offset, int line) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2830 | { | 
| Al Viro | 29756fa | 2006-10-10 22:47:27 +0100 | [diff] [blame] | 2831 | void __iomem *ptr; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2832 | unsigned char	val; | 
|  | 2833 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2834 | if (offset > brdp->memsize) { | 
|  | 2835 | printk(KERN_ERR "STALLION: shared memory pointer=%x out of " | 
|  | 2836 | "range at line=%d(%d), brd=%d\n", | 
|  | 2837 | (int) offset, line, __LINE__, brdp->brdnr); | 
|  | 2838 | ptr = NULL; | 
|  | 2839 | val = 0; | 
|  | 2840 | } else { | 
|  | 2841 | ptr = brdp->membase + (offset % ECP_EIPAGESIZE); | 
|  | 2842 | if (offset < ECP_EIPAGESIZE) | 
|  | 2843 | val = ECP_EIENABLE; | 
|  | 2844 | else | 
|  | 2845 | val = ECP_EIENABLE | 0x40; | 
|  | 2846 | } | 
|  | 2847 | outb(val, (brdp->iobase + ECP_EICONFR)); | 
|  | 2848 | return(ptr); | 
|  | 2849 | } | 
|  | 2850 |  | 
|  | 2851 | /*****************************************************************************/ | 
|  | 2852 |  | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 2853 | static void stli_ecpeireset(struct stlibrd *brdp) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2854 | { | 
|  | 2855 | outb(ECP_EISTOP, (brdp->iobase + ECP_EICONFR)); | 
|  | 2856 | udelay(10); | 
|  | 2857 | outb(ECP_EIDISABLE, (brdp->iobase + ECP_EICONFR)); | 
|  | 2858 | udelay(500); | 
|  | 2859 | } | 
|  | 2860 |  | 
|  | 2861 | /*****************************************************************************/ | 
|  | 2862 |  | 
|  | 2863 | /* | 
|  | 2864 | *	The following set of functions act on ECP MCA boards. | 
|  | 2865 | */ | 
|  | 2866 |  | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 2867 | static void stli_ecpmcenable(struct stlibrd *brdp) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2868 | { | 
|  | 2869 | outb(ECP_MCENABLE, (brdp->iobase + ECP_MCCONFR)); | 
|  | 2870 | } | 
|  | 2871 |  | 
|  | 2872 | /*****************************************************************************/ | 
|  | 2873 |  | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 2874 | static void stli_ecpmcdisable(struct stlibrd *brdp) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2875 | { | 
|  | 2876 | outb(ECP_MCDISABLE, (brdp->iobase + ECP_MCCONFR)); | 
|  | 2877 | } | 
|  | 2878 |  | 
|  | 2879 | /*****************************************************************************/ | 
|  | 2880 |  | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 2881 | static void __iomem *stli_ecpmcgetmemptr(struct stlibrd *brdp, unsigned long offset, int line) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2882 | { | 
| Al Viro | 29756fa | 2006-10-10 22:47:27 +0100 | [diff] [blame] | 2883 | void __iomem *ptr; | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 2884 | unsigned char val; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2885 |  | 
|  | 2886 | if (offset > brdp->memsize) { | 
|  | 2887 | printk(KERN_ERR "STALLION: shared memory pointer=%x out of " | 
|  | 2888 | "range at line=%d(%d), brd=%d\n", | 
|  | 2889 | (int) offset, line, __LINE__, brdp->brdnr); | 
|  | 2890 | ptr = NULL; | 
|  | 2891 | val = 0; | 
|  | 2892 | } else { | 
|  | 2893 | ptr = brdp->membase + (offset % ECP_MCPAGESIZE); | 
|  | 2894 | val = ((unsigned char) (offset / ECP_MCPAGESIZE)) | ECP_MCENABLE; | 
|  | 2895 | } | 
|  | 2896 | outb(val, (brdp->iobase + ECP_MCCONFR)); | 
|  | 2897 | return(ptr); | 
|  | 2898 | } | 
|  | 2899 |  | 
|  | 2900 | /*****************************************************************************/ | 
|  | 2901 |  | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 2902 | static void stli_ecpmcreset(struct stlibrd *brdp) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2903 | { | 
|  | 2904 | outb(ECP_MCSTOP, (brdp->iobase + ECP_MCCONFR)); | 
|  | 2905 | udelay(10); | 
|  | 2906 | outb(ECP_MCDISABLE, (brdp->iobase + ECP_MCCONFR)); | 
|  | 2907 | udelay(500); | 
|  | 2908 | } | 
|  | 2909 |  | 
|  | 2910 | /*****************************************************************************/ | 
|  | 2911 |  | 
|  | 2912 | /* | 
|  | 2913 | *	The following set of functions act on ECP PCI boards. | 
|  | 2914 | */ | 
|  | 2915 |  | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 2916 | static void stli_ecppciinit(struct stlibrd *brdp) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2917 | { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2918 | outb(ECP_PCISTOP, (brdp->iobase + ECP_PCICONFR)); | 
|  | 2919 | udelay(10); | 
|  | 2920 | outb(0, (brdp->iobase + ECP_PCICONFR)); | 
|  | 2921 | udelay(500); | 
|  | 2922 | } | 
|  | 2923 |  | 
|  | 2924 | /*****************************************************************************/ | 
|  | 2925 |  | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 2926 | static void __iomem *stli_ecppcigetmemptr(struct stlibrd *brdp, unsigned long offset, int line) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2927 | { | 
| Al Viro | 29756fa | 2006-10-10 22:47:27 +0100 | [diff] [blame] | 2928 | void __iomem *ptr; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2929 | unsigned char	val; | 
|  | 2930 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2931 | if (offset > brdp->memsize) { | 
|  | 2932 | printk(KERN_ERR "STALLION: shared memory pointer=%x out of " | 
|  | 2933 | "range at line=%d(%d), board=%d\n", | 
|  | 2934 | (int) offset, line, __LINE__, brdp->brdnr); | 
|  | 2935 | ptr = NULL; | 
|  | 2936 | val = 0; | 
|  | 2937 | } else { | 
|  | 2938 | ptr = brdp->membase + (offset % ECP_PCIPAGESIZE); | 
|  | 2939 | val = (offset / ECP_PCIPAGESIZE) << 1; | 
|  | 2940 | } | 
|  | 2941 | outb(val, (brdp->iobase + ECP_PCICONFR)); | 
|  | 2942 | return(ptr); | 
|  | 2943 | } | 
|  | 2944 |  | 
|  | 2945 | /*****************************************************************************/ | 
|  | 2946 |  | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 2947 | static void stli_ecppcireset(struct stlibrd *brdp) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2948 | { | 
|  | 2949 | outb(ECP_PCISTOP, (brdp->iobase + ECP_PCICONFR)); | 
|  | 2950 | udelay(10); | 
|  | 2951 | outb(0, (brdp->iobase + ECP_PCICONFR)); | 
|  | 2952 | udelay(500); | 
|  | 2953 | } | 
|  | 2954 |  | 
|  | 2955 | /*****************************************************************************/ | 
|  | 2956 |  | 
|  | 2957 | /* | 
|  | 2958 | *	The following routines act on ONboards. | 
|  | 2959 | */ | 
|  | 2960 |  | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 2961 | static void stli_onbinit(struct stlibrd *brdp) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2962 | { | 
|  | 2963 | unsigned long	memconf; | 
|  | 2964 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2965 | outb(ONB_ATSTOP, (brdp->iobase + ONB_ATCONFR)); | 
|  | 2966 | udelay(10); | 
|  | 2967 | outb(ONB_ATDISABLE, (brdp->iobase + ONB_ATCONFR)); | 
|  | 2968 | mdelay(1000); | 
|  | 2969 |  | 
|  | 2970 | memconf = (brdp->memaddr & ONB_ATADDRMASK) >> ONB_ATADDRSHFT; | 
|  | 2971 | outb(memconf, (brdp->iobase + ONB_ATMEMAR)); | 
|  | 2972 | outb(0x1, brdp->iobase); | 
|  | 2973 | mdelay(1); | 
|  | 2974 | } | 
|  | 2975 |  | 
|  | 2976 | /*****************************************************************************/ | 
|  | 2977 |  | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 2978 | static void stli_onbenable(struct stlibrd *brdp) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2979 | { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2980 | outb((brdp->enabval | ONB_ATENABLE), (brdp->iobase + ONB_ATCONFR)); | 
|  | 2981 | } | 
|  | 2982 |  | 
|  | 2983 | /*****************************************************************************/ | 
|  | 2984 |  | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 2985 | static void stli_onbdisable(struct stlibrd *brdp) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2986 | { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2987 | outb((brdp->enabval | ONB_ATDISABLE), (brdp->iobase + ONB_ATCONFR)); | 
|  | 2988 | } | 
|  | 2989 |  | 
|  | 2990 | /*****************************************************************************/ | 
|  | 2991 |  | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 2992 | static void __iomem *stli_onbgetmemptr(struct stlibrd *brdp, unsigned long offset, int line) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2993 | { | 
| Al Viro | 29756fa | 2006-10-10 22:47:27 +0100 | [diff] [blame] | 2994 | void __iomem *ptr; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2995 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2996 | if (offset > brdp->memsize) { | 
|  | 2997 | printk(KERN_ERR "STALLION: shared memory pointer=%x out of " | 
|  | 2998 | "range at line=%d(%d), brd=%d\n", | 
|  | 2999 | (int) offset, line, __LINE__, brdp->brdnr); | 
|  | 3000 | ptr = NULL; | 
|  | 3001 | } else { | 
|  | 3002 | ptr = brdp->membase + (offset % ONB_ATPAGESIZE); | 
|  | 3003 | } | 
|  | 3004 | return(ptr); | 
|  | 3005 | } | 
|  | 3006 |  | 
|  | 3007 | /*****************************************************************************/ | 
|  | 3008 |  | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 3009 | static void stli_onbreset(struct stlibrd *brdp) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3010 | { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3011 | outb(ONB_ATSTOP, (brdp->iobase + ONB_ATCONFR)); | 
|  | 3012 | udelay(10); | 
|  | 3013 | outb(ONB_ATDISABLE, (brdp->iobase + ONB_ATCONFR)); | 
|  | 3014 | mdelay(1000); | 
|  | 3015 | } | 
|  | 3016 |  | 
|  | 3017 | /*****************************************************************************/ | 
|  | 3018 |  | 
|  | 3019 | /* | 
|  | 3020 | *	The following routines act on ONboard EISA. | 
|  | 3021 | */ | 
|  | 3022 |  | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 3023 | static void stli_onbeinit(struct stlibrd *brdp) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3024 | { | 
|  | 3025 | unsigned long	memconf; | 
|  | 3026 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3027 | outb(0x1, (brdp->iobase + ONB_EIBRDENAB)); | 
|  | 3028 | outb(ONB_EISTOP, (brdp->iobase + ONB_EICONFR)); | 
|  | 3029 | udelay(10); | 
|  | 3030 | outb(ONB_EIDISABLE, (brdp->iobase + ONB_EICONFR)); | 
|  | 3031 | mdelay(1000); | 
|  | 3032 |  | 
|  | 3033 | memconf = (brdp->memaddr & ONB_EIADDRMASKL) >> ONB_EIADDRSHFTL; | 
|  | 3034 | outb(memconf, (brdp->iobase + ONB_EIMEMARL)); | 
|  | 3035 | memconf = (brdp->memaddr & ONB_EIADDRMASKH) >> ONB_EIADDRSHFTH; | 
|  | 3036 | outb(memconf, (brdp->iobase + ONB_EIMEMARH)); | 
|  | 3037 | outb(0x1, brdp->iobase); | 
|  | 3038 | mdelay(1); | 
|  | 3039 | } | 
|  | 3040 |  | 
|  | 3041 | /*****************************************************************************/ | 
|  | 3042 |  | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 3043 | static void stli_onbeenable(struct stlibrd *brdp) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3044 | { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3045 | outb(ONB_EIENABLE, (brdp->iobase + ONB_EICONFR)); | 
|  | 3046 | } | 
|  | 3047 |  | 
|  | 3048 | /*****************************************************************************/ | 
|  | 3049 |  | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 3050 | static void stli_onbedisable(struct stlibrd *brdp) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3051 | { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3052 | outb(ONB_EIDISABLE, (brdp->iobase + ONB_EICONFR)); | 
|  | 3053 | } | 
|  | 3054 |  | 
|  | 3055 | /*****************************************************************************/ | 
|  | 3056 |  | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 3057 | static void __iomem *stli_onbegetmemptr(struct stlibrd *brdp, unsigned long offset, int line) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3058 | { | 
| Al Viro | 29756fa | 2006-10-10 22:47:27 +0100 | [diff] [blame] | 3059 | void __iomem *ptr; | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 3060 | unsigned char val; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3061 |  | 
|  | 3062 | if (offset > brdp->memsize) { | 
|  | 3063 | printk(KERN_ERR "STALLION: shared memory pointer=%x out of " | 
|  | 3064 | "range at line=%d(%d), brd=%d\n", | 
|  | 3065 | (int) offset, line, __LINE__, brdp->brdnr); | 
|  | 3066 | ptr = NULL; | 
|  | 3067 | val = 0; | 
|  | 3068 | } else { | 
|  | 3069 | ptr = brdp->membase + (offset % ONB_EIPAGESIZE); | 
|  | 3070 | if (offset < ONB_EIPAGESIZE) | 
|  | 3071 | val = ONB_EIENABLE; | 
|  | 3072 | else | 
|  | 3073 | val = ONB_EIENABLE | 0x40; | 
|  | 3074 | } | 
|  | 3075 | outb(val, (brdp->iobase + ONB_EICONFR)); | 
|  | 3076 | return(ptr); | 
|  | 3077 | } | 
|  | 3078 |  | 
|  | 3079 | /*****************************************************************************/ | 
|  | 3080 |  | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 3081 | static void stli_onbereset(struct stlibrd *brdp) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3082 | { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3083 | outb(ONB_EISTOP, (brdp->iobase + ONB_EICONFR)); | 
|  | 3084 | udelay(10); | 
|  | 3085 | outb(ONB_EIDISABLE, (brdp->iobase + ONB_EICONFR)); | 
|  | 3086 | mdelay(1000); | 
|  | 3087 | } | 
|  | 3088 |  | 
|  | 3089 | /*****************************************************************************/ | 
|  | 3090 |  | 
|  | 3091 | /* | 
|  | 3092 | *	The following routines act on Brumby boards. | 
|  | 3093 | */ | 
|  | 3094 |  | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 3095 | static void stli_bbyinit(struct stlibrd *brdp) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3096 | { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3097 | outb(BBY_ATSTOP, (brdp->iobase + BBY_ATCONFR)); | 
|  | 3098 | udelay(10); | 
|  | 3099 | outb(0, (brdp->iobase + BBY_ATCONFR)); | 
|  | 3100 | mdelay(1000); | 
|  | 3101 | outb(0x1, brdp->iobase); | 
|  | 3102 | mdelay(1); | 
|  | 3103 | } | 
|  | 3104 |  | 
|  | 3105 | /*****************************************************************************/ | 
|  | 3106 |  | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 3107 | static void __iomem *stli_bbygetmemptr(struct stlibrd *brdp, unsigned long offset, int line) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3108 | { | 
| Al Viro | 29756fa | 2006-10-10 22:47:27 +0100 | [diff] [blame] | 3109 | void __iomem *ptr; | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 3110 | unsigned char val; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3111 |  | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 3112 | BUG_ON(offset > brdp->memsize); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3113 |  | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 3114 | ptr = brdp->membase + (offset % BBY_PAGESIZE); | 
|  | 3115 | val = (unsigned char) (offset / BBY_PAGESIZE); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3116 | outb(val, (brdp->iobase + BBY_ATCONFR)); | 
|  | 3117 | return(ptr); | 
|  | 3118 | } | 
|  | 3119 |  | 
|  | 3120 | /*****************************************************************************/ | 
|  | 3121 |  | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 3122 | static void stli_bbyreset(struct stlibrd *brdp) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3123 | { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3124 | outb(BBY_ATSTOP, (brdp->iobase + BBY_ATCONFR)); | 
|  | 3125 | udelay(10); | 
|  | 3126 | outb(0, (brdp->iobase + BBY_ATCONFR)); | 
|  | 3127 | mdelay(1000); | 
|  | 3128 | } | 
|  | 3129 |  | 
|  | 3130 | /*****************************************************************************/ | 
|  | 3131 |  | 
|  | 3132 | /* | 
|  | 3133 | *	The following routines act on original old Stallion boards. | 
|  | 3134 | */ | 
|  | 3135 |  | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 3136 | static void stli_stalinit(struct stlibrd *brdp) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3137 | { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3138 | outb(0x1, brdp->iobase); | 
|  | 3139 | mdelay(1000); | 
|  | 3140 | } | 
|  | 3141 |  | 
|  | 3142 | /*****************************************************************************/ | 
|  | 3143 |  | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 3144 | static void __iomem *stli_stalgetmemptr(struct stlibrd *brdp, unsigned long offset, int line) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3145 | { | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 3146 | BUG_ON(offset > brdp->memsize); | 
|  | 3147 | return brdp->membase + (offset % STAL_PAGESIZE); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3148 | } | 
|  | 3149 |  | 
|  | 3150 | /*****************************************************************************/ | 
|  | 3151 |  | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 3152 | static void stli_stalreset(struct stlibrd *brdp) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3153 | { | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 3154 | u32 __iomem *vecp; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3155 |  | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 3156 | vecp = (u32 __iomem *) (brdp->membase + 0x30); | 
|  | 3157 | writel(0xffff0000, vecp); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3158 | outb(0, brdp->iobase); | 
|  | 3159 | mdelay(1000); | 
|  | 3160 | } | 
|  | 3161 |  | 
|  | 3162 | /*****************************************************************************/ | 
|  | 3163 |  | 
|  | 3164 | /* | 
|  | 3165 | *	Try to find an ECP board and initialize it. This handles only ECP | 
|  | 3166 | *	board types. | 
|  | 3167 | */ | 
|  | 3168 |  | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 3169 | static int stli_initecp(struct stlibrd *brdp) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3170 | { | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 3171 | cdkecpsig_t sig; | 
|  | 3172 | cdkecpsig_t __iomem *sigsp; | 
|  | 3173 | unsigned int status, nxtid; | 
|  | 3174 | char *name; | 
| Jiri Slaby | 8f8f5a5 | 2006-12-08 02:39:23 -0800 | [diff] [blame] | 3175 | int retval, panelnr, nrports; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3176 |  | 
| Jiri Slaby | 8f8f5a5 | 2006-12-08 02:39:23 -0800 | [diff] [blame] | 3177 | if ((brdp->iobase == 0) || (brdp->memaddr == 0)) { | 
|  | 3178 | retval = -ENODEV; | 
|  | 3179 | goto err; | 
|  | 3180 | } | 
|  | 3181 |  | 
| Ingo Korb | b306122 | 2007-07-17 04:05:23 -0700 | [diff] [blame] | 3182 | brdp->iosize = ECP_IOSIZE; | 
|  | 3183 |  | 
| Jiri Slaby | 8f8f5a5 | 2006-12-08 02:39:23 -0800 | [diff] [blame] | 3184 | if (!request_region(brdp->iobase, brdp->iosize, "istallion")) { | 
|  | 3185 | retval = -EIO; | 
|  | 3186 | goto err; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3187 | } | 
|  | 3188 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3189 | /* | 
|  | 3190 | *	Based on the specific board type setup the common vars to access | 
|  | 3191 | *	and enable shared memory. Set all board specific information now | 
|  | 3192 | *	as well. | 
|  | 3193 | */ | 
|  | 3194 | switch (brdp->brdtype) { | 
|  | 3195 | case BRD_ECP: | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3196 | brdp->memsize = ECP_MEMSIZE; | 
|  | 3197 | brdp->pagesize = ECP_ATPAGESIZE; | 
|  | 3198 | brdp->init = stli_ecpinit; | 
|  | 3199 | brdp->enable = stli_ecpenable; | 
|  | 3200 | brdp->reenable = stli_ecpenable; | 
|  | 3201 | brdp->disable = stli_ecpdisable; | 
|  | 3202 | brdp->getmemptr = stli_ecpgetmemptr; | 
|  | 3203 | brdp->intr = stli_ecpintr; | 
|  | 3204 | brdp->reset = stli_ecpreset; | 
|  | 3205 | name = "serial(EC8/64)"; | 
|  | 3206 | break; | 
|  | 3207 |  | 
|  | 3208 | case BRD_ECPE: | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3209 | brdp->memsize = ECP_MEMSIZE; | 
|  | 3210 | brdp->pagesize = ECP_EIPAGESIZE; | 
|  | 3211 | brdp->init = stli_ecpeiinit; | 
|  | 3212 | brdp->enable = stli_ecpeienable; | 
|  | 3213 | brdp->reenable = stli_ecpeienable; | 
|  | 3214 | brdp->disable = stli_ecpeidisable; | 
|  | 3215 | brdp->getmemptr = stli_ecpeigetmemptr; | 
|  | 3216 | brdp->intr = stli_ecpintr; | 
|  | 3217 | brdp->reset = stli_ecpeireset; | 
|  | 3218 | name = "serial(EC8/64-EI)"; | 
|  | 3219 | break; | 
|  | 3220 |  | 
|  | 3221 | case BRD_ECPMC: | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3222 | brdp->memsize = ECP_MEMSIZE; | 
|  | 3223 | brdp->pagesize = ECP_MCPAGESIZE; | 
|  | 3224 | brdp->init = NULL; | 
|  | 3225 | brdp->enable = stli_ecpmcenable; | 
|  | 3226 | brdp->reenable = stli_ecpmcenable; | 
|  | 3227 | brdp->disable = stli_ecpmcdisable; | 
|  | 3228 | brdp->getmemptr = stli_ecpmcgetmemptr; | 
|  | 3229 | brdp->intr = stli_ecpintr; | 
|  | 3230 | brdp->reset = stli_ecpmcreset; | 
|  | 3231 | name = "serial(EC8/64-MCA)"; | 
|  | 3232 | break; | 
|  | 3233 |  | 
|  | 3234 | case BRD_ECPPCI: | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3235 | brdp->memsize = ECP_PCIMEMSIZE; | 
|  | 3236 | brdp->pagesize = ECP_PCIPAGESIZE; | 
|  | 3237 | brdp->init = stli_ecppciinit; | 
|  | 3238 | brdp->enable = NULL; | 
|  | 3239 | brdp->reenable = NULL; | 
|  | 3240 | brdp->disable = NULL; | 
|  | 3241 | brdp->getmemptr = stli_ecppcigetmemptr; | 
|  | 3242 | brdp->intr = stli_ecpintr; | 
|  | 3243 | brdp->reset = stli_ecppcireset; | 
|  | 3244 | name = "serial(EC/RA-PCI)"; | 
|  | 3245 | break; | 
|  | 3246 |  | 
|  | 3247 | default: | 
| Jiri Slaby | 8f8f5a5 | 2006-12-08 02:39:23 -0800 | [diff] [blame] | 3248 | retval = -EINVAL; | 
|  | 3249 | goto err_reg; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3250 | } | 
|  | 3251 |  | 
|  | 3252 | /* | 
|  | 3253 | *	The per-board operations structure is all set up, so now let's go | 
|  | 3254 | *	and get the board operational. Firstly initialize board configuration | 
|  | 3255 | *	registers. Set the memory mapping info so we can get at the boards | 
|  | 3256 | *	shared memory. | 
|  | 3257 | */ | 
|  | 3258 | EBRDINIT(brdp); | 
|  | 3259 |  | 
| Alan Cox | 24cb233 | 2008-04-30 00:54:19 -0700 | [diff] [blame] | 3260 | brdp->membase = ioremap_nocache(brdp->memaddr, brdp->memsize); | 
| Jiri Slaby | 8f8f5a5 | 2006-12-08 02:39:23 -0800 | [diff] [blame] | 3261 | if (brdp->membase == NULL) { | 
|  | 3262 | retval = -ENOMEM; | 
|  | 3263 | goto err_reg; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3264 | } | 
|  | 3265 |  | 
|  | 3266 | /* | 
|  | 3267 | *	Now that all specific code is set up, enable the shared memory and | 
|  | 3268 | *	look for the a signature area that will tell us exactly what board | 
|  | 3269 | *	this is, and what it is connected to it. | 
|  | 3270 | */ | 
|  | 3271 | EBRDENABLE(brdp); | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 3272 | sigsp = (cdkecpsig_t __iomem *) EBRDGETMEMPTR(brdp, CDK_SIGADDR); | 
| Al Viro | 634965f | 2006-09-23 01:20:31 +0100 | [diff] [blame] | 3273 | memcpy_fromio(&sig, sigsp, sizeof(cdkecpsig_t)); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3274 | EBRDDISABLE(brdp); | 
|  | 3275 |  | 
| Jiri Slaby | 8f8f5a5 | 2006-12-08 02:39:23 -0800 | [diff] [blame] | 3276 | if (sig.magic != cpu_to_le32(ECP_MAGIC)) { | 
|  | 3277 | retval = -ENODEV; | 
|  | 3278 | goto err_unmap; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3279 | } | 
|  | 3280 |  | 
|  | 3281 | /* | 
|  | 3282 | *	Scan through the signature looking at the panels connected to the | 
|  | 3283 | *	board. Calculate the total number of ports as we go. | 
|  | 3284 | */ | 
|  | 3285 | for (panelnr = 0, nxtid = 0; (panelnr < STL_MAXPANELS); panelnr++) { | 
|  | 3286 | status = sig.panelid[nxtid]; | 
|  | 3287 | if ((status & ECH_PNLIDMASK) != nxtid) | 
|  | 3288 | break; | 
|  | 3289 |  | 
|  | 3290 | brdp->panelids[panelnr] = status; | 
|  | 3291 | nrports = (status & ECH_PNL16PORT) ? 16 : 8; | 
|  | 3292 | if ((nrports == 16) && ((status & ECH_PNLXPID) == 0)) | 
|  | 3293 | nxtid++; | 
|  | 3294 | brdp->panels[panelnr] = nrports; | 
|  | 3295 | brdp->nrports += nrports; | 
|  | 3296 | nxtid++; | 
|  | 3297 | brdp->nrpanels++; | 
|  | 3298 | } | 
|  | 3299 |  | 
|  | 3300 |  | 
|  | 3301 | brdp->state |= BST_FOUND; | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 3302 | return 0; | 
| Jiri Slaby | 8f8f5a5 | 2006-12-08 02:39:23 -0800 | [diff] [blame] | 3303 | err_unmap: | 
|  | 3304 | iounmap(brdp->membase); | 
|  | 3305 | brdp->membase = NULL; | 
|  | 3306 | err_reg: | 
|  | 3307 | release_region(brdp->iobase, brdp->iosize); | 
|  | 3308 | err: | 
|  | 3309 | return retval; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3310 | } | 
|  | 3311 |  | 
|  | 3312 | /*****************************************************************************/ | 
|  | 3313 |  | 
|  | 3314 | /* | 
|  | 3315 | *	Try to find an ONboard, Brumby or Stallion board and initialize it. | 
|  | 3316 | *	This handles only these board types. | 
|  | 3317 | */ | 
|  | 3318 |  | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 3319 | static int stli_initonb(struct stlibrd *brdp) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3320 | { | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 3321 | cdkonbsig_t sig; | 
|  | 3322 | cdkonbsig_t __iomem *sigsp; | 
|  | 3323 | char *name; | 
| Jiri Slaby | 8f8f5a5 | 2006-12-08 02:39:23 -0800 | [diff] [blame] | 3324 | int i, retval; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3325 |  | 
|  | 3326 | /* | 
|  | 3327 | *	Do a basic sanity check on the IO and memory addresses. | 
|  | 3328 | */ | 
| Jiri Slaby | 8f8f5a5 | 2006-12-08 02:39:23 -0800 | [diff] [blame] | 3329 | if (brdp->iobase == 0 || brdp->memaddr == 0) { | 
|  | 3330 | retval = -ENODEV; | 
|  | 3331 | goto err; | 
|  | 3332 | } | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3333 |  | 
|  | 3334 | brdp->iosize = ONB_IOSIZE; | 
|  | 3335 |  | 
| Jiri Slaby | 8f8f5a5 | 2006-12-08 02:39:23 -0800 | [diff] [blame] | 3336 | if (!request_region(brdp->iobase, brdp->iosize, "istallion")) { | 
|  | 3337 | retval = -EIO; | 
|  | 3338 | goto err; | 
|  | 3339 | } | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3340 |  | 
|  | 3341 | /* | 
|  | 3342 | *	Based on the specific board type setup the common vars to access | 
|  | 3343 | *	and enable shared memory. Set all board specific information now | 
|  | 3344 | *	as well. | 
|  | 3345 | */ | 
|  | 3346 | switch (brdp->brdtype) { | 
|  | 3347 | case BRD_ONBOARD: | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3348 | case BRD_ONBOARD2: | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3349 | brdp->memsize = ONB_MEMSIZE; | 
|  | 3350 | brdp->pagesize = ONB_ATPAGESIZE; | 
|  | 3351 | brdp->init = stli_onbinit; | 
|  | 3352 | brdp->enable = stli_onbenable; | 
|  | 3353 | brdp->reenable = stli_onbenable; | 
|  | 3354 | brdp->disable = stli_onbdisable; | 
|  | 3355 | brdp->getmemptr = stli_onbgetmemptr; | 
|  | 3356 | brdp->intr = stli_ecpintr; | 
|  | 3357 | brdp->reset = stli_onbreset; | 
|  | 3358 | if (brdp->memaddr > 0x100000) | 
|  | 3359 | brdp->enabval = ONB_MEMENABHI; | 
|  | 3360 | else | 
|  | 3361 | brdp->enabval = ONB_MEMENABLO; | 
|  | 3362 | name = "serial(ONBoard)"; | 
|  | 3363 | break; | 
|  | 3364 |  | 
|  | 3365 | case BRD_ONBOARDE: | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3366 | brdp->memsize = ONB_EIMEMSIZE; | 
|  | 3367 | brdp->pagesize = ONB_EIPAGESIZE; | 
|  | 3368 | brdp->init = stli_onbeinit; | 
|  | 3369 | brdp->enable = stli_onbeenable; | 
|  | 3370 | brdp->reenable = stli_onbeenable; | 
|  | 3371 | brdp->disable = stli_onbedisable; | 
|  | 3372 | brdp->getmemptr = stli_onbegetmemptr; | 
|  | 3373 | brdp->intr = stli_ecpintr; | 
|  | 3374 | brdp->reset = stli_onbereset; | 
|  | 3375 | name = "serial(ONBoard/E)"; | 
|  | 3376 | break; | 
|  | 3377 |  | 
|  | 3378 | case BRD_BRUMBY4: | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3379 | brdp->memsize = BBY_MEMSIZE; | 
|  | 3380 | brdp->pagesize = BBY_PAGESIZE; | 
|  | 3381 | brdp->init = stli_bbyinit; | 
|  | 3382 | brdp->enable = NULL; | 
|  | 3383 | brdp->reenable = NULL; | 
|  | 3384 | brdp->disable = NULL; | 
|  | 3385 | brdp->getmemptr = stli_bbygetmemptr; | 
|  | 3386 | brdp->intr = stli_ecpintr; | 
|  | 3387 | brdp->reset = stli_bbyreset; | 
|  | 3388 | name = "serial(Brumby)"; | 
|  | 3389 | break; | 
|  | 3390 |  | 
|  | 3391 | case BRD_STALLION: | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3392 | brdp->memsize = STAL_MEMSIZE; | 
|  | 3393 | brdp->pagesize = STAL_PAGESIZE; | 
|  | 3394 | brdp->init = stli_stalinit; | 
|  | 3395 | brdp->enable = NULL; | 
|  | 3396 | brdp->reenable = NULL; | 
|  | 3397 | brdp->disable = NULL; | 
|  | 3398 | brdp->getmemptr = stli_stalgetmemptr; | 
|  | 3399 | brdp->intr = stli_ecpintr; | 
|  | 3400 | brdp->reset = stli_stalreset; | 
|  | 3401 | name = "serial(Stallion)"; | 
|  | 3402 | break; | 
|  | 3403 |  | 
|  | 3404 | default: | 
| Jiri Slaby | 8f8f5a5 | 2006-12-08 02:39:23 -0800 | [diff] [blame] | 3405 | retval = -EINVAL; | 
|  | 3406 | goto err_reg; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3407 | } | 
|  | 3408 |  | 
|  | 3409 | /* | 
|  | 3410 | *	The per-board operations structure is all set up, so now let's go | 
|  | 3411 | *	and get the board operational. Firstly initialize board configuration | 
|  | 3412 | *	registers. Set the memory mapping info so we can get at the boards | 
|  | 3413 | *	shared memory. | 
|  | 3414 | */ | 
|  | 3415 | EBRDINIT(brdp); | 
|  | 3416 |  | 
| Alan Cox | 24cb233 | 2008-04-30 00:54:19 -0700 | [diff] [blame] | 3417 | brdp->membase = ioremap_nocache(brdp->memaddr, brdp->memsize); | 
| Jiri Slaby | 8f8f5a5 | 2006-12-08 02:39:23 -0800 | [diff] [blame] | 3418 | if (brdp->membase == NULL) { | 
|  | 3419 | retval = -ENOMEM; | 
|  | 3420 | goto err_reg; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3421 | } | 
|  | 3422 |  | 
|  | 3423 | /* | 
|  | 3424 | *	Now that all specific code is set up, enable the shared memory and | 
|  | 3425 | *	look for the a signature area that will tell us exactly what board | 
|  | 3426 | *	this is, and how many ports. | 
|  | 3427 | */ | 
|  | 3428 | EBRDENABLE(brdp); | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 3429 | sigsp = (cdkonbsig_t __iomem *) EBRDGETMEMPTR(brdp, CDK_SIGADDR); | 
|  | 3430 | memcpy_fromio(&sig, sigsp, sizeof(cdkonbsig_t)); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3431 | EBRDDISABLE(brdp); | 
|  | 3432 |  | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 3433 | if (sig.magic0 != cpu_to_le16(ONB_MAGIC0) || | 
|  | 3434 | sig.magic1 != cpu_to_le16(ONB_MAGIC1) || | 
|  | 3435 | sig.magic2 != cpu_to_le16(ONB_MAGIC2) || | 
| Jiri Slaby | 8f8f5a5 | 2006-12-08 02:39:23 -0800 | [diff] [blame] | 3436 | sig.magic3 != cpu_to_le16(ONB_MAGIC3)) { | 
|  | 3437 | retval = -ENODEV; | 
|  | 3438 | goto err_unmap; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3439 | } | 
|  | 3440 |  | 
|  | 3441 | /* | 
|  | 3442 | *	Scan through the signature alive mask and calculate how many ports | 
|  | 3443 | *	there are on this board. | 
|  | 3444 | */ | 
|  | 3445 | brdp->nrpanels = 1; | 
|  | 3446 | if (sig.amask1) { | 
|  | 3447 | brdp->nrports = 32; | 
|  | 3448 | } else { | 
|  | 3449 | for (i = 0; (i < 16); i++) { | 
|  | 3450 | if (((sig.amask0 << i) & 0x8000) == 0) | 
|  | 3451 | break; | 
|  | 3452 | } | 
|  | 3453 | brdp->nrports = i; | 
|  | 3454 | } | 
|  | 3455 | brdp->panels[0] = brdp->nrports; | 
|  | 3456 |  | 
|  | 3457 |  | 
|  | 3458 | brdp->state |= BST_FOUND; | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 3459 | return 0; | 
| Jiri Slaby | 8f8f5a5 | 2006-12-08 02:39:23 -0800 | [diff] [blame] | 3460 | err_unmap: | 
|  | 3461 | iounmap(brdp->membase); | 
|  | 3462 | brdp->membase = NULL; | 
|  | 3463 | err_reg: | 
|  | 3464 | release_region(brdp->iobase, brdp->iosize); | 
|  | 3465 | err: | 
|  | 3466 | return retval; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3467 | } | 
|  | 3468 |  | 
|  | 3469 | /*****************************************************************************/ | 
|  | 3470 |  | 
|  | 3471 | /* | 
|  | 3472 | *	Start up a running board. This routine is only called after the | 
|  | 3473 | *	code has been down loaded to the board and is operational. It will | 
|  | 3474 | *	read in the memory map, and get the show on the road... | 
|  | 3475 | */ | 
|  | 3476 |  | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 3477 | static int stli_startbrd(struct stlibrd *brdp) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3478 | { | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 3479 | cdkhdr_t __iomem *hdrp; | 
|  | 3480 | cdkmem_t __iomem *memp; | 
|  | 3481 | cdkasy_t __iomem *ap; | 
|  | 3482 | unsigned long flags; | 
| Jiri Slaby | 1328d73 | 2006-12-08 02:39:19 -0800 | [diff] [blame] | 3483 | unsigned int portnr, nrdevs, i; | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 3484 | struct stliport *portp; | 
| Jiri Slaby | 1328d73 | 2006-12-08 02:39:19 -0800 | [diff] [blame] | 3485 | int rc = 0; | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 3486 | u32 memoff; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3487 |  | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 3488 | spin_lock_irqsave(&brd_lock, flags); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3489 | EBRDENABLE(brdp); | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 3490 | hdrp = (cdkhdr_t __iomem *) EBRDGETMEMPTR(brdp, CDK_CDKADDR); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3491 | nrdevs = hdrp->nrdevs; | 
|  | 3492 |  | 
|  | 3493 | #if 0 | 
|  | 3494 | printk("%s(%d): CDK version %d.%d.%d --> " | 
|  | 3495 | "nrdevs=%d memp=%x hostp=%x slavep=%x\n", | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 3496 | __FILE__, __LINE__, readb(&hdrp->ver_release), readb(&hdrp->ver_modification), | 
|  | 3497 | readb(&hdrp->ver_fix), nrdevs, (int) readl(&hdrp->memp), readl(&hdrp->hostp), | 
|  | 3498 | readl(&hdrp->slavep)); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3499 | #endif | 
|  | 3500 |  | 
|  | 3501 | if (nrdevs < (brdp->nrports + 1)) { | 
|  | 3502 | printk(KERN_ERR "STALLION: slave failed to allocate memory for " | 
|  | 3503 | "all devices, devices=%d\n", nrdevs); | 
|  | 3504 | brdp->nrports = nrdevs - 1; | 
|  | 3505 | } | 
|  | 3506 | brdp->nrdevs = nrdevs; | 
|  | 3507 | brdp->hostoffset = hdrp->hostp - CDK_CDKADDR; | 
|  | 3508 | brdp->slaveoffset = hdrp->slavep - CDK_CDKADDR; | 
|  | 3509 | brdp->bitsize = (nrdevs + 7) / 8; | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 3510 | memoff = readl(&hdrp->memp); | 
|  | 3511 | if (memoff > brdp->memsize) { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3512 | printk(KERN_ERR "STALLION: corrupted shared memory region?\n"); | 
|  | 3513 | rc = -EIO; | 
|  | 3514 | goto stli_donestartup; | 
|  | 3515 | } | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 3516 | memp = (cdkmem_t __iomem *) EBRDGETMEMPTR(brdp, memoff); | 
|  | 3517 | if (readw(&memp->dtype) != TYP_ASYNCTRL) { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3518 | printk(KERN_ERR "STALLION: no slave control device found\n"); | 
|  | 3519 | goto stli_donestartup; | 
|  | 3520 | } | 
|  | 3521 | memp++; | 
|  | 3522 |  | 
|  | 3523 | /* | 
|  | 3524 | *	Cycle through memory allocation of each port. We are guaranteed to | 
|  | 3525 | *	have all ports inside the first page of slave window, so no need to | 
|  | 3526 | *	change pages while reading memory map. | 
|  | 3527 | */ | 
|  | 3528 | for (i = 1, portnr = 0; (i < nrdevs); i++, portnr++, memp++) { | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 3529 | if (readw(&memp->dtype) != TYP_ASYNC) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3530 | break; | 
|  | 3531 | portp = brdp->ports[portnr]; | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 3532 | if (portp == NULL) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3533 | break; | 
|  | 3534 | portp->devnr = i; | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 3535 | portp->addr = readl(&memp->offset); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3536 | portp->reqbit = (unsigned char) (0x1 << (i * 8 / nrdevs)); | 
|  | 3537 | portp->portidx = (unsigned char) (i / 8); | 
|  | 3538 | portp->portbit = (unsigned char) (0x1 << (i % 8)); | 
|  | 3539 | } | 
|  | 3540 |  | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 3541 | writeb(0xff, &hdrp->slavereq); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3542 |  | 
|  | 3543 | /* | 
|  | 3544 | *	For each port setup a local copy of the RX and TX buffer offsets | 
|  | 3545 | *	and sizes. We do this separate from the above, because we need to | 
|  | 3546 | *	move the shared memory page... | 
|  | 3547 | */ | 
|  | 3548 | for (i = 1, portnr = 0; (i < nrdevs); i++, portnr++) { | 
|  | 3549 | portp = brdp->ports[portnr]; | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 3550 | if (portp == NULL) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3551 | break; | 
|  | 3552 | if (portp->addr == 0) | 
|  | 3553 | break; | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 3554 | ap = (cdkasy_t __iomem *) EBRDGETMEMPTR(brdp, portp->addr); | 
|  | 3555 | if (ap != NULL) { | 
|  | 3556 | portp->rxsize = readw(&ap->rxq.size); | 
|  | 3557 | portp->txsize = readw(&ap->txq.size); | 
|  | 3558 | portp->rxoffset = readl(&ap->rxq.offset); | 
|  | 3559 | portp->txoffset = readl(&ap->txq.offset); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3560 | } | 
|  | 3561 | } | 
|  | 3562 |  | 
|  | 3563 | stli_donestartup: | 
|  | 3564 | EBRDDISABLE(brdp); | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 3565 | spin_unlock_irqrestore(&brd_lock, flags); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3566 |  | 
|  | 3567 | if (rc == 0) | 
|  | 3568 | brdp->state |= BST_STARTED; | 
|  | 3569 |  | 
|  | 3570 | if (! stli_timeron) { | 
|  | 3571 | stli_timeron++; | 
| Jiri Slaby | ff8efe9 | 2006-12-08 02:39:27 -0800 | [diff] [blame] | 3572 | mod_timer(&stli_timerlist, STLI_TIMEOUT); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3573 | } | 
|  | 3574 |  | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 3575 | return rc; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3576 | } | 
|  | 3577 |  | 
|  | 3578 | /*****************************************************************************/ | 
|  | 3579 |  | 
|  | 3580 | /* | 
|  | 3581 | *	Probe and initialize the specified board. | 
|  | 3582 | */ | 
|  | 3583 |  | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 3584 | static int __devinit stli_brdinit(struct stlibrd *brdp) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3585 | { | 
| Jiri Slaby | 8f8f5a5 | 2006-12-08 02:39:23 -0800 | [diff] [blame] | 3586 | int retval; | 
|  | 3587 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3588 | switch (brdp->brdtype) { | 
|  | 3589 | case BRD_ECP: | 
|  | 3590 | case BRD_ECPE: | 
|  | 3591 | case BRD_ECPMC: | 
|  | 3592 | case BRD_ECPPCI: | 
| Jiri Slaby | 8f8f5a5 | 2006-12-08 02:39:23 -0800 | [diff] [blame] | 3593 | retval = stli_initecp(brdp); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3594 | break; | 
|  | 3595 | case BRD_ONBOARD: | 
|  | 3596 | case BRD_ONBOARDE: | 
|  | 3597 | case BRD_ONBOARD2: | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3598 | case BRD_BRUMBY4: | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3599 | case BRD_STALLION: | 
| Jiri Slaby | 8f8f5a5 | 2006-12-08 02:39:23 -0800 | [diff] [blame] | 3600 | retval = stli_initonb(brdp); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3601 | break; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3602 | default: | 
|  | 3603 | printk(KERN_ERR "STALLION: board=%d is unknown board " | 
|  | 3604 | "type=%d\n", brdp->brdnr, brdp->brdtype); | 
| Jiri Slaby | 8f8f5a5 | 2006-12-08 02:39:23 -0800 | [diff] [blame] | 3605 | retval = -ENODEV; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3606 | } | 
|  | 3607 |  | 
| Jiri Slaby | 8f8f5a5 | 2006-12-08 02:39:23 -0800 | [diff] [blame] | 3608 | if (retval) | 
|  | 3609 | return retval; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3610 |  | 
|  | 3611 | stli_initports(brdp); | 
|  | 3612 | printk(KERN_INFO "STALLION: %s found, board=%d io=%x mem=%x " | 
|  | 3613 | "nrpanels=%d nrports=%d\n", stli_brdnames[brdp->brdtype], | 
|  | 3614 | brdp->brdnr, brdp->iobase, (int) brdp->memaddr, | 
|  | 3615 | brdp->nrpanels, brdp->nrports); | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 3616 | return 0; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3617 | } | 
|  | 3618 |  | 
| Jiri Slaby | a00f33f | 2006-12-08 02:39:20 -0800 | [diff] [blame] | 3619 | #if STLI_EISAPROBE != 0 | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3620 | /*****************************************************************************/ | 
|  | 3621 |  | 
|  | 3622 | /* | 
|  | 3623 | *	Probe around trying to find where the EISA boards shared memory | 
|  | 3624 | *	might be. This is a bit if hack, but it is the best we can do. | 
|  | 3625 | */ | 
|  | 3626 |  | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 3627 | static int stli_eisamemprobe(struct stlibrd *brdp) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3628 | { | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 3629 | cdkecpsig_t	ecpsig, __iomem *ecpsigp; | 
|  | 3630 | cdkonbsig_t	onbsig, __iomem *onbsigp; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3631 | int		i, foundit; | 
|  | 3632 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3633 | /* | 
|  | 3634 | *	First up we reset the board, to get it into a known state. There | 
|  | 3635 | *	is only 2 board types here we need to worry about. Don;t use the | 
|  | 3636 | *	standard board init routine here, it programs up the shared | 
|  | 3637 | *	memory address, and we don't know it yet... | 
|  | 3638 | */ | 
|  | 3639 | if (brdp->brdtype == BRD_ECPE) { | 
|  | 3640 | outb(0x1, (brdp->iobase + ECP_EIBRDENAB)); | 
|  | 3641 | outb(ECP_EISTOP, (brdp->iobase + ECP_EICONFR)); | 
|  | 3642 | udelay(10); | 
|  | 3643 | outb(ECP_EIDISABLE, (brdp->iobase + ECP_EICONFR)); | 
|  | 3644 | udelay(500); | 
|  | 3645 | stli_ecpeienable(brdp); | 
|  | 3646 | } else if (brdp->brdtype == BRD_ONBOARDE) { | 
|  | 3647 | outb(0x1, (brdp->iobase + ONB_EIBRDENAB)); | 
|  | 3648 | outb(ONB_EISTOP, (brdp->iobase + ONB_EICONFR)); | 
|  | 3649 | udelay(10); | 
|  | 3650 | outb(ONB_EIDISABLE, (brdp->iobase + ONB_EICONFR)); | 
|  | 3651 | mdelay(100); | 
|  | 3652 | outb(0x1, brdp->iobase); | 
|  | 3653 | mdelay(1); | 
|  | 3654 | stli_onbeenable(brdp); | 
|  | 3655 | } else { | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 3656 | return -ENODEV; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3657 | } | 
|  | 3658 |  | 
|  | 3659 | foundit = 0; | 
|  | 3660 | brdp->memsize = ECP_MEMSIZE; | 
|  | 3661 |  | 
|  | 3662 | /* | 
|  | 3663 | *	Board shared memory is enabled, so now we have a poke around and | 
|  | 3664 | *	see if we can find it. | 
|  | 3665 | */ | 
|  | 3666 | for (i = 0; (i < stli_eisamempsize); i++) { | 
|  | 3667 | brdp->memaddr = stli_eisamemprobeaddrs[i]; | 
| Alan Cox | 24cb233 | 2008-04-30 00:54:19 -0700 | [diff] [blame] | 3668 | brdp->membase = ioremap_nocache(brdp->memaddr, brdp->memsize); | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 3669 | if (brdp->membase == NULL) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3670 | continue; | 
|  | 3671 |  | 
|  | 3672 | if (brdp->brdtype == BRD_ECPE) { | 
| Al Viro | 29756fa | 2006-10-10 22:47:27 +0100 | [diff] [blame] | 3673 | ecpsigp = stli_ecpeigetmemptr(brdp, | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3674 | CDK_SIGADDR, __LINE__); | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 3675 | memcpy_fromio(&ecpsig, ecpsigp, sizeof(cdkecpsig_t)); | 
|  | 3676 | if (ecpsig.magic == cpu_to_le32(ECP_MAGIC)) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3677 | foundit = 1; | 
|  | 3678 | } else { | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 3679 | onbsigp = (cdkonbsig_t __iomem *) stli_onbegetmemptr(brdp, | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3680 | CDK_SIGADDR, __LINE__); | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 3681 | memcpy_fromio(&onbsig, onbsigp, sizeof(cdkonbsig_t)); | 
|  | 3682 | if ((onbsig.magic0 == cpu_to_le16(ONB_MAGIC0)) && | 
|  | 3683 | (onbsig.magic1 == cpu_to_le16(ONB_MAGIC1)) && | 
|  | 3684 | (onbsig.magic2 == cpu_to_le16(ONB_MAGIC2)) && | 
|  | 3685 | (onbsig.magic3 == cpu_to_le16(ONB_MAGIC3))) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3686 | foundit = 1; | 
|  | 3687 | } | 
|  | 3688 |  | 
|  | 3689 | iounmap(brdp->membase); | 
|  | 3690 | if (foundit) | 
|  | 3691 | break; | 
|  | 3692 | } | 
|  | 3693 |  | 
|  | 3694 | /* | 
|  | 3695 | *	Regardless of whether we found the shared memory or not we must | 
|  | 3696 | *	disable the region. After that return success or failure. | 
|  | 3697 | */ | 
|  | 3698 | if (brdp->brdtype == BRD_ECPE) | 
|  | 3699 | stli_ecpeidisable(brdp); | 
|  | 3700 | else | 
|  | 3701 | stli_onbedisable(brdp); | 
|  | 3702 |  | 
|  | 3703 | if (! foundit) { | 
|  | 3704 | brdp->memaddr = 0; | 
|  | 3705 | brdp->membase = NULL; | 
|  | 3706 | printk(KERN_ERR "STALLION: failed to probe shared memory " | 
|  | 3707 | "region for %s in EISA slot=%d\n", | 
|  | 3708 | stli_brdnames[brdp->brdtype], (brdp->iobase >> 12)); | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 3709 | return -ENODEV; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3710 | } | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 3711 | return 0; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3712 | } | 
| Jiri Slaby | a00f33f | 2006-12-08 02:39:20 -0800 | [diff] [blame] | 3713 | #endif | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3714 |  | 
|  | 3715 | static int stli_getbrdnr(void) | 
|  | 3716 | { | 
| Jiri Slaby | 1328d73 | 2006-12-08 02:39:19 -0800 | [diff] [blame] | 3717 | unsigned int i; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3718 |  | 
|  | 3719 | for (i = 0; i < STL_MAXBRDS; i++) { | 
|  | 3720 | if (!stli_brds[i]) { | 
|  | 3721 | if (i >= stli_nrbrds) | 
|  | 3722 | stli_nrbrds = i + 1; | 
|  | 3723 | return i; | 
|  | 3724 | } | 
|  | 3725 | } | 
|  | 3726 | return -1; | 
|  | 3727 | } | 
|  | 3728 |  | 
| Jiri Slaby | a00f33f | 2006-12-08 02:39:20 -0800 | [diff] [blame] | 3729 | #if STLI_EISAPROBE != 0 | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3730 | /*****************************************************************************/ | 
|  | 3731 |  | 
|  | 3732 | /* | 
|  | 3733 | *	Probe around and try to find any EISA boards in system. The biggest | 
|  | 3734 | *	problem here is finding out what memory address is associated with | 
|  | 3735 | *	an EISA board after it is found. The registers of the ECPE and | 
|  | 3736 | *	ONboardE are not readable - so we can't read them from there. We | 
|  | 3737 | *	don't have access to the EISA CMOS (or EISA BIOS) so we don't | 
|  | 3738 | *	actually have any way to find out the real value. The best we can | 
|  | 3739 | *	do is go probing around in the usual places hoping we can find it. | 
|  | 3740 | */ | 
|  | 3741 |  | 
|  | 3742 | static int stli_findeisabrds(void) | 
|  | 3743 | { | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 3744 | struct stlibrd *brdp; | 
| Jiri Slaby | 1328d73 | 2006-12-08 02:39:19 -0800 | [diff] [blame] | 3745 | unsigned int iobase, eid, i; | 
| Jiri Slaby | 8f8f5a5 | 2006-12-08 02:39:23 -0800 | [diff] [blame] | 3746 | int brdnr, found = 0; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3747 |  | 
|  | 3748 | /* | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 3749 | *	Firstly check if this is an EISA system.  If this is not an EISA system then | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3750 | *	don't bother going any further! | 
|  | 3751 | */ | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 3752 | if (EISA_bus) | 
|  | 3753 | return 0; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3754 |  | 
|  | 3755 | /* | 
|  | 3756 | *	Looks like an EISA system, so go searching for EISA boards. | 
|  | 3757 | */ | 
|  | 3758 | for (iobase = 0x1000; (iobase <= 0xc000); iobase += 0x1000) { | 
|  | 3759 | outb(0xff, (iobase + 0xc80)); | 
|  | 3760 | eid = inb(iobase + 0xc80); | 
|  | 3761 | eid |= inb(iobase + 0xc81) << 8; | 
|  | 3762 | if (eid != STL_EISAID) | 
|  | 3763 | continue; | 
|  | 3764 |  | 
|  | 3765 | /* | 
|  | 3766 | *		We have found a board. Need to check if this board was | 
|  | 3767 | *		statically configured already (just in case!). | 
|  | 3768 | */ | 
|  | 3769 | for (i = 0; (i < STL_MAXBRDS); i++) { | 
|  | 3770 | brdp = stli_brds[i]; | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 3771 | if (brdp == NULL) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3772 | continue; | 
|  | 3773 | if (brdp->iobase == iobase) | 
|  | 3774 | break; | 
|  | 3775 | } | 
|  | 3776 | if (i < STL_MAXBRDS) | 
|  | 3777 | continue; | 
|  | 3778 |  | 
|  | 3779 | /* | 
|  | 3780 | *		We have found a Stallion board and it is not configured already. | 
|  | 3781 | *		Allocate a board structure and initialize it. | 
|  | 3782 | */ | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 3783 | if ((brdp = stli_allocbrd()) == NULL) | 
| Jiri Slaby | 8f8f5a5 | 2006-12-08 02:39:23 -0800 | [diff] [blame] | 3784 | return found ? : -ENOMEM; | 
| Jiri Slaby | 1328d73 | 2006-12-08 02:39:19 -0800 | [diff] [blame] | 3785 | brdnr = stli_getbrdnr(); | 
|  | 3786 | if (brdnr < 0) | 
| Jiri Slaby | 8f8f5a5 | 2006-12-08 02:39:23 -0800 | [diff] [blame] | 3787 | return found ? : -ENOMEM; | 
| Jiri Slaby | 1328d73 | 2006-12-08 02:39:19 -0800 | [diff] [blame] | 3788 | brdp->brdnr = (unsigned int)brdnr; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3789 | eid = inb(iobase + 0xc82); | 
|  | 3790 | if (eid == ECP_EISAID) | 
|  | 3791 | brdp->brdtype = BRD_ECPE; | 
|  | 3792 | else if (eid == ONB_EISAID) | 
|  | 3793 | brdp->brdtype = BRD_ONBOARDE; | 
|  | 3794 | else | 
|  | 3795 | brdp->brdtype = BRD_UNKNOWN; | 
|  | 3796 | brdp->iobase = iobase; | 
|  | 3797 | outb(0x1, (iobase + 0xc84)); | 
|  | 3798 | if (stli_eisamemprobe(brdp)) | 
|  | 3799 | outb(0, (iobase + 0xc84)); | 
| Jiri Slaby | 8f8f5a5 | 2006-12-08 02:39:23 -0800 | [diff] [blame] | 3800 | if (stli_brdinit(brdp) < 0) { | 
|  | 3801 | kfree(brdp); | 
|  | 3802 | continue; | 
|  | 3803 | } | 
|  | 3804 |  | 
| Jiri Slaby | b103b5c | 2006-12-08 02:39:21 -0800 | [diff] [blame] | 3805 | stli_brds[brdp->brdnr] = brdp; | 
| Jiri Slaby | 8f8f5a5 | 2006-12-08 02:39:23 -0800 | [diff] [blame] | 3806 | found++; | 
| Jiri Slaby | ec3dde5 | 2006-12-08 02:39:26 -0800 | [diff] [blame] | 3807 |  | 
|  | 3808 | for (i = 0; i < brdp->nrports; i++) | 
|  | 3809 | tty_register_device(stli_serial, | 
|  | 3810 | brdp->brdnr * STL_MAXPORTS + i, NULL); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3811 | } | 
|  | 3812 |  | 
| Jiri Slaby | 8f8f5a5 | 2006-12-08 02:39:23 -0800 | [diff] [blame] | 3813 | return found; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3814 | } | 
| Jiri Slaby | a00f33f | 2006-12-08 02:39:20 -0800 | [diff] [blame] | 3815 | #else | 
|  | 3816 | static inline int stli_findeisabrds(void) { return 0; } | 
|  | 3817 | #endif | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3818 |  | 
|  | 3819 | /*****************************************************************************/ | 
|  | 3820 |  | 
|  | 3821 | /* | 
|  | 3822 | *	Find the next available board number that is free. | 
|  | 3823 | */ | 
|  | 3824 |  | 
|  | 3825 | /*****************************************************************************/ | 
|  | 3826 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3827 | /* | 
|  | 3828 | *	We have a Stallion board. Allocate a board structure and | 
|  | 3829 | *	initialize it. Read its IO and MEMORY resources from PCI | 
|  | 3830 | *	configuration space. | 
|  | 3831 | */ | 
|  | 3832 |  | 
| Jiri Slaby | 845bead | 2006-12-08 02:39:17 -0800 | [diff] [blame] | 3833 | static int __devinit stli_pciprobe(struct pci_dev *pdev, | 
|  | 3834 | const struct pci_device_id *ent) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3835 | { | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 3836 | struct stlibrd *brdp; | 
| Jiri Slaby | ec3dde5 | 2006-12-08 02:39:26 -0800 | [diff] [blame] | 3837 | unsigned int i; | 
| Jiri Slaby | 1328d73 | 2006-12-08 02:39:19 -0800 | [diff] [blame] | 3838 | int brdnr, retval = -EIO; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3839 |  | 
| Jiri Slaby | 845bead | 2006-12-08 02:39:17 -0800 | [diff] [blame] | 3840 | retval = pci_enable_device(pdev); | 
|  | 3841 | if (retval) | 
|  | 3842 | goto err; | 
|  | 3843 | brdp = stli_allocbrd(); | 
|  | 3844 | if (brdp == NULL) { | 
|  | 3845 | retval = -ENOMEM; | 
|  | 3846 | goto err; | 
|  | 3847 | } | 
| Jiri Slaby | b103b5c | 2006-12-08 02:39:21 -0800 | [diff] [blame] | 3848 | mutex_lock(&stli_brdslock); | 
| Jiri Slaby | 1328d73 | 2006-12-08 02:39:19 -0800 | [diff] [blame] | 3849 | brdnr = stli_getbrdnr(); | 
| Jiri Slaby | b103b5c | 2006-12-08 02:39:21 -0800 | [diff] [blame] | 3850 | if (brdnr < 0) { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3851 | printk(KERN_INFO "STALLION: too many boards found, " | 
|  | 3852 | "maximum supported %d\n", STL_MAXBRDS); | 
| Jiri Slaby | b103b5c | 2006-12-08 02:39:21 -0800 | [diff] [blame] | 3853 | mutex_unlock(&stli_brdslock); | 
| Jiri Slaby | 845bead | 2006-12-08 02:39:17 -0800 | [diff] [blame] | 3854 | retval = -EIO; | 
|  | 3855 | goto err_fr; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3856 | } | 
| Jiri Slaby | 1328d73 | 2006-12-08 02:39:19 -0800 | [diff] [blame] | 3857 | brdp->brdnr = (unsigned int)brdnr; | 
| Jiri Slaby | b103b5c | 2006-12-08 02:39:21 -0800 | [diff] [blame] | 3858 | stli_brds[brdp->brdnr] = brdp; | 
|  | 3859 | mutex_unlock(&stli_brdslock); | 
| Jiri Slaby | 845bead | 2006-12-08 02:39:17 -0800 | [diff] [blame] | 3860 | brdp->brdtype = BRD_ECPPCI; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3861 | /* | 
|  | 3862 | *	We have all resources from the board, so lets setup the actual | 
|  | 3863 | *	board structure now. | 
|  | 3864 | */ | 
| Jiri Slaby | 845bead | 2006-12-08 02:39:17 -0800 | [diff] [blame] | 3865 | brdp->iobase = pci_resource_start(pdev, 3); | 
|  | 3866 | brdp->memaddr = pci_resource_start(pdev, 2); | 
|  | 3867 | retval = stli_brdinit(brdp); | 
|  | 3868 | if (retval) | 
| Jiri Slaby | b103b5c | 2006-12-08 02:39:21 -0800 | [diff] [blame] | 3869 | goto err_null; | 
| Jiri Slaby | 845bead | 2006-12-08 02:39:17 -0800 | [diff] [blame] | 3870 |  | 
| Jiri Slaby | 3901417 | 2006-12-08 02:39:22 -0800 | [diff] [blame] | 3871 | brdp->state |= BST_PROBED; | 
| Jiri Slaby | 845bead | 2006-12-08 02:39:17 -0800 | [diff] [blame] | 3872 | pci_set_drvdata(pdev, brdp); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3873 |  | 
| Jiri Slaby | 140e92a | 2006-12-08 02:39:24 -0800 | [diff] [blame] | 3874 | EBRDENABLE(brdp); | 
|  | 3875 | brdp->enable = NULL; | 
|  | 3876 | brdp->disable = NULL; | 
|  | 3877 |  | 
| Jiri Slaby | ec3dde5 | 2006-12-08 02:39:26 -0800 | [diff] [blame] | 3878 | for (i = 0; i < brdp->nrports; i++) | 
|  | 3879 | tty_register_device(stli_serial, brdp->brdnr * STL_MAXPORTS + i, | 
|  | 3880 | &pdev->dev); | 
|  | 3881 |  | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 3882 | return 0; | 
| Jiri Slaby | b103b5c | 2006-12-08 02:39:21 -0800 | [diff] [blame] | 3883 | err_null: | 
|  | 3884 | stli_brds[brdp->brdnr] = NULL; | 
| Jiri Slaby | 845bead | 2006-12-08 02:39:17 -0800 | [diff] [blame] | 3885 | err_fr: | 
|  | 3886 | kfree(brdp); | 
|  | 3887 | err: | 
|  | 3888 | return retval; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3889 | } | 
|  | 3890 |  | 
| Jiri Slaby | 845bead | 2006-12-08 02:39:17 -0800 | [diff] [blame] | 3891 | static void stli_pciremove(struct pci_dev *pdev) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3892 | { | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 3893 | struct stlibrd *brdp = pci_get_drvdata(pdev); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3894 |  | 
| Jiri Slaby | 845bead | 2006-12-08 02:39:17 -0800 | [diff] [blame] | 3895 | stli_cleanup_ports(brdp); | 
|  | 3896 |  | 
|  | 3897 | iounmap(brdp->membase); | 
|  | 3898 | if (brdp->iosize > 0) | 
|  | 3899 | release_region(brdp->iobase, brdp->iosize); | 
|  | 3900 |  | 
|  | 3901 | stli_brds[brdp->brdnr] = NULL; | 
|  | 3902 | kfree(brdp); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3903 | } | 
|  | 3904 |  | 
| Jiri Slaby | 845bead | 2006-12-08 02:39:17 -0800 | [diff] [blame] | 3905 | static struct pci_driver stli_pcidriver = { | 
|  | 3906 | .name = "istallion", | 
|  | 3907 | .id_table = istallion_pci_tbl, | 
|  | 3908 | .probe = stli_pciprobe, | 
|  | 3909 | .remove = __devexit_p(stli_pciremove) | 
|  | 3910 | }; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3911 | /*****************************************************************************/ | 
|  | 3912 |  | 
|  | 3913 | /* | 
|  | 3914 | *	Allocate a new board structure. Fill out the basic info in it. | 
|  | 3915 | */ | 
|  | 3916 |  | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 3917 | static struct stlibrd *stli_allocbrd(void) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3918 | { | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 3919 | struct stlibrd *brdp; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3920 |  | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 3921 | brdp = kzalloc(sizeof(struct stlibrd), GFP_KERNEL); | 
| Tobias Klauser | b0b4ed7 | 2006-03-31 02:30:56 -0800 | [diff] [blame] | 3922 | if (!brdp) { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3923 | printk(KERN_ERR "STALLION: failed to allocate memory " | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 3924 | "(size=%Zd)\n", sizeof(struct stlibrd)); | 
| Tobias Klauser | b0b4ed7 | 2006-03-31 02:30:56 -0800 | [diff] [blame] | 3925 | return NULL; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3926 | } | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3927 | brdp->magic = STLI_BOARDMAGIC; | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 3928 | return brdp; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3929 | } | 
|  | 3930 |  | 
|  | 3931 | /*****************************************************************************/ | 
|  | 3932 |  | 
|  | 3933 | /* | 
|  | 3934 | *	Scan through all the boards in the configuration and see what we | 
|  | 3935 | *	can find. | 
|  | 3936 | */ | 
|  | 3937 |  | 
|  | 3938 | static int stli_initbrds(void) | 
|  | 3939 | { | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 3940 | struct stlibrd *brdp, *nxtbrdp; | 
|  | 3941 | struct stlconf conf; | 
| Jiri Slaby | 8f8f5a5 | 2006-12-08 02:39:23 -0800 | [diff] [blame] | 3942 | unsigned int i, j, found = 0; | 
| Jiri Slaby | 1328d73 | 2006-12-08 02:39:19 -0800 | [diff] [blame] | 3943 | int retval; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3944 |  | 
| Jiri Slaby | a3f8d9d | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 3945 | for (stli_nrbrds = 0; stli_nrbrds < ARRAY_SIZE(stli_brdsp); | 
|  | 3946 | stli_nrbrds++) { | 
|  | 3947 | memset(&conf, 0, sizeof(conf)); | 
|  | 3948 | if (stli_parsebrd(&conf, stli_brdsp[stli_nrbrds]) == 0) | 
|  | 3949 | continue; | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 3950 | if ((brdp = stli_allocbrd()) == NULL) | 
| Jiri Slaby | a3f8d9d | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 3951 | continue; | 
|  | 3952 | brdp->brdnr = stli_nrbrds; | 
|  | 3953 | brdp->brdtype = conf.brdtype; | 
|  | 3954 | brdp->iobase = conf.ioaddr1; | 
|  | 3955 | brdp->memaddr = conf.memaddr; | 
| Jiri Slaby | 8f8f5a5 | 2006-12-08 02:39:23 -0800 | [diff] [blame] | 3956 | if (stli_brdinit(brdp) < 0) { | 
|  | 3957 | kfree(brdp); | 
|  | 3958 | continue; | 
|  | 3959 | } | 
| Jiri Slaby | b103b5c | 2006-12-08 02:39:21 -0800 | [diff] [blame] | 3960 | stli_brds[brdp->brdnr] = brdp; | 
| Jiri Slaby | 8f8f5a5 | 2006-12-08 02:39:23 -0800 | [diff] [blame] | 3961 | found++; | 
| Jiri Slaby | ec3dde5 | 2006-12-08 02:39:26 -0800 | [diff] [blame] | 3962 |  | 
|  | 3963 | for (i = 0; i < brdp->nrports; i++) | 
|  | 3964 | tty_register_device(stli_serial, | 
|  | 3965 | brdp->brdnr * STL_MAXPORTS + i, NULL); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3966 | } | 
|  | 3967 |  | 
| Jiri Slaby | 8f8f5a5 | 2006-12-08 02:39:23 -0800 | [diff] [blame] | 3968 | retval = stli_findeisabrds(); | 
|  | 3969 | if (retval > 0) | 
|  | 3970 | found += retval; | 
| Jiri Slaby | 845bead | 2006-12-08 02:39:17 -0800 | [diff] [blame] | 3971 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3972 | /* | 
|  | 3973 | *	All found boards are initialized. Now for a little optimization, if | 
|  | 3974 | *	no boards are sharing the "shared memory" regions then we can just | 
|  | 3975 | *	leave them all enabled. This is in fact the usual case. | 
|  | 3976 | */ | 
|  | 3977 | stli_shared = 0; | 
|  | 3978 | if (stli_nrbrds > 1) { | 
|  | 3979 | for (i = 0; (i < stli_nrbrds); i++) { | 
|  | 3980 | brdp = stli_brds[i]; | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 3981 | if (brdp == NULL) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3982 | continue; | 
|  | 3983 | for (j = i + 1; (j < stli_nrbrds); j++) { | 
|  | 3984 | nxtbrdp = stli_brds[j]; | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 3985 | if (nxtbrdp == NULL) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3986 | continue; | 
|  | 3987 | if ((brdp->membase >= nxtbrdp->membase) && | 
|  | 3988 | (brdp->membase <= (nxtbrdp->membase + | 
|  | 3989 | nxtbrdp->memsize - 1))) { | 
|  | 3990 | stli_shared++; | 
|  | 3991 | break; | 
|  | 3992 | } | 
|  | 3993 | } | 
|  | 3994 | } | 
|  | 3995 | } | 
|  | 3996 |  | 
|  | 3997 | if (stli_shared == 0) { | 
|  | 3998 | for (i = 0; (i < stli_nrbrds); i++) { | 
|  | 3999 | brdp = stli_brds[i]; | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 4000 | if (brdp == NULL) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 4001 | continue; | 
|  | 4002 | if (brdp->state & BST_FOUND) { | 
|  | 4003 | EBRDENABLE(brdp); | 
|  | 4004 | brdp->enable = NULL; | 
|  | 4005 | brdp->disable = NULL; | 
|  | 4006 | } | 
|  | 4007 | } | 
|  | 4008 | } | 
|  | 4009 |  | 
| Jiri Slaby | 140e92a | 2006-12-08 02:39:24 -0800 | [diff] [blame] | 4010 | retval = pci_register_driver(&stli_pcidriver); | 
|  | 4011 | if (retval && found == 0) { | 
|  | 4012 | printk(KERN_ERR "Neither isa nor eisa cards found nor pci " | 
|  | 4013 | "driver can be registered!\n"); | 
|  | 4014 | goto err; | 
|  | 4015 | } | 
|  | 4016 |  | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 4017 | return 0; | 
| Jiri Slaby | 8f8f5a5 | 2006-12-08 02:39:23 -0800 | [diff] [blame] | 4018 | err: | 
|  | 4019 | return retval; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 4020 | } | 
|  | 4021 |  | 
|  | 4022 | /*****************************************************************************/ | 
|  | 4023 |  | 
|  | 4024 | /* | 
|  | 4025 | *	Code to handle an "staliomem" read operation. This device is the | 
|  | 4026 | *	contents of the board shared memory. It is used for down loading | 
|  | 4027 | *	the slave image (and debugging :-) | 
|  | 4028 | */ | 
|  | 4029 |  | 
|  | 4030 | static ssize_t stli_memread(struct file *fp, char __user *buf, size_t count, loff_t *offp) | 
|  | 4031 | { | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 4032 | unsigned long flags; | 
| Al Viro | 29756fa | 2006-10-10 22:47:27 +0100 | [diff] [blame] | 4033 | void __iomem *memptr; | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 4034 | struct stlibrd *brdp; | 
| Jiri Slaby | 1328d73 | 2006-12-08 02:39:19 -0800 | [diff] [blame] | 4035 | unsigned int brdnr; | 
|  | 4036 | int size, n; | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 4037 | void *p; | 
|  | 4038 | loff_t off = *offp; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 4039 |  | 
| Josef Sipek | a7113a9 | 2006-12-08 02:36:55 -0800 | [diff] [blame] | 4040 | brdnr = iminor(fp->f_path.dentry->d_inode); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 4041 | if (brdnr >= stli_nrbrds) | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 4042 | return -ENODEV; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 4043 | brdp = stli_brds[brdnr]; | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 4044 | if (brdp == NULL) | 
|  | 4045 | return -ENODEV; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 4046 | if (brdp->state == 0) | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 4047 | return -ENODEV; | 
|  | 4048 | if (off >= brdp->memsize || off + count < off) | 
|  | 4049 | return 0; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 4050 |  | 
| Jiri Slaby | a3f8d9d | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 4051 | size = min(count, (size_t)(brdp->memsize - off)); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 4052 |  | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 4053 | /* | 
|  | 4054 | *	Copy the data a page at a time | 
|  | 4055 | */ | 
|  | 4056 |  | 
|  | 4057 | p = (void *)__get_free_page(GFP_KERNEL); | 
|  | 4058 | if(p == NULL) | 
|  | 4059 | return -ENOMEM; | 
|  | 4060 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 4061 | while (size > 0) { | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 4062 | spin_lock_irqsave(&brd_lock, flags); | 
|  | 4063 | EBRDENABLE(brdp); | 
| Al Viro | 29756fa | 2006-10-10 22:47:27 +0100 | [diff] [blame] | 4064 | memptr = EBRDGETMEMPTR(brdp, off); | 
| Jiri Slaby | a3f8d9d | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 4065 | n = min(size, (int)(brdp->pagesize - (((unsigned long) off) % brdp->pagesize))); | 
|  | 4066 | n = min(n, (int)PAGE_SIZE); | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 4067 | memcpy_fromio(p, memptr, n); | 
|  | 4068 | EBRDDISABLE(brdp); | 
|  | 4069 | spin_unlock_irqrestore(&brd_lock, flags); | 
|  | 4070 | if (copy_to_user(buf, p, n)) { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 4071 | count = -EFAULT; | 
|  | 4072 | goto out; | 
|  | 4073 | } | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 4074 | off += n; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 4075 | buf += n; | 
|  | 4076 | size -= n; | 
|  | 4077 | } | 
|  | 4078 | out: | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 4079 | *offp = off; | 
|  | 4080 | free_page((unsigned long)p); | 
|  | 4081 | return count; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 4082 | } | 
|  | 4083 |  | 
|  | 4084 | /*****************************************************************************/ | 
|  | 4085 |  | 
|  | 4086 | /* | 
|  | 4087 | *	Code to handle an "staliomem" write operation. This device is the | 
|  | 4088 | *	contents of the board shared memory. It is used for down loading | 
|  | 4089 | *	the slave image (and debugging :-) | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 4090 | * | 
|  | 4091 | *	FIXME: copy under lock | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 4092 | */ | 
|  | 4093 |  | 
|  | 4094 | static ssize_t stli_memwrite(struct file *fp, const char __user *buf, size_t count, loff_t *offp) | 
|  | 4095 | { | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 4096 | unsigned long flags; | 
| Al Viro | 29756fa | 2006-10-10 22:47:27 +0100 | [diff] [blame] | 4097 | void __iomem *memptr; | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 4098 | struct stlibrd *brdp; | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 4099 | char __user *chbuf; | 
| Jiri Slaby | 1328d73 | 2006-12-08 02:39:19 -0800 | [diff] [blame] | 4100 | unsigned int brdnr; | 
|  | 4101 | int size, n; | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 4102 | void *p; | 
|  | 4103 | loff_t off = *offp; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 4104 |  | 
| Josef Sipek | a7113a9 | 2006-12-08 02:36:55 -0800 | [diff] [blame] | 4105 | brdnr = iminor(fp->f_path.dentry->d_inode); | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 4106 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 4107 | if (brdnr >= stli_nrbrds) | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 4108 | return -ENODEV; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 4109 | brdp = stli_brds[brdnr]; | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 4110 | if (brdp == NULL) | 
|  | 4111 | return -ENODEV; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 4112 | if (brdp->state == 0) | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 4113 | return -ENODEV; | 
|  | 4114 | if (off >= brdp->memsize || off + count < off) | 
|  | 4115 | return 0; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 4116 |  | 
|  | 4117 | chbuf = (char __user *) buf; | 
| Jiri Slaby | a3f8d9d | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 4118 | size = min(count, (size_t)(brdp->memsize - off)); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 4119 |  | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 4120 | /* | 
|  | 4121 | *	Copy the data a page at a time | 
|  | 4122 | */ | 
|  | 4123 |  | 
|  | 4124 | p = (void *)__get_free_page(GFP_KERNEL); | 
|  | 4125 | if(p == NULL) | 
|  | 4126 | return -ENOMEM; | 
|  | 4127 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 4128 | while (size > 0) { | 
| Jiri Slaby | a3f8d9d | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 4129 | n = min(size, (int)(brdp->pagesize - (((unsigned long) off) % brdp->pagesize))); | 
|  | 4130 | n = min(n, (int)PAGE_SIZE); | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 4131 | if (copy_from_user(p, chbuf, n)) { | 
|  | 4132 | if (count == 0) | 
|  | 4133 | count = -EFAULT; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 4134 | goto out; | 
|  | 4135 | } | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 4136 | spin_lock_irqsave(&brd_lock, flags); | 
|  | 4137 | EBRDENABLE(brdp); | 
| Al Viro | 29756fa | 2006-10-10 22:47:27 +0100 | [diff] [blame] | 4138 | memptr = EBRDGETMEMPTR(brdp, off); | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 4139 | memcpy_toio(memptr, p, n); | 
|  | 4140 | EBRDDISABLE(brdp); | 
|  | 4141 | spin_unlock_irqrestore(&brd_lock, flags); | 
|  | 4142 | off += n; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 4143 | chbuf += n; | 
|  | 4144 | size -= n; | 
|  | 4145 | } | 
|  | 4146 | out: | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 4147 | free_page((unsigned long) p); | 
|  | 4148 | *offp = off; | 
|  | 4149 | return count; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 4150 | } | 
|  | 4151 |  | 
|  | 4152 | /*****************************************************************************/ | 
|  | 4153 |  | 
|  | 4154 | /* | 
|  | 4155 | *	Return the board stats structure to user app. | 
|  | 4156 | */ | 
|  | 4157 |  | 
|  | 4158 | static int stli_getbrdstats(combrd_t __user *bp) | 
|  | 4159 | { | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 4160 | struct stlibrd *brdp; | 
| Jiri Slaby | 1328d73 | 2006-12-08 02:39:19 -0800 | [diff] [blame] | 4161 | unsigned int i; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 4162 |  | 
|  | 4163 | if (copy_from_user(&stli_brdstats, bp, sizeof(combrd_t))) | 
|  | 4164 | return -EFAULT; | 
|  | 4165 | if (stli_brdstats.brd >= STL_MAXBRDS) | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 4166 | return -ENODEV; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 4167 | brdp = stli_brds[stli_brdstats.brd]; | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 4168 | if (brdp == NULL) | 
|  | 4169 | return -ENODEV; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 4170 |  | 
|  | 4171 | memset(&stli_brdstats, 0, sizeof(combrd_t)); | 
|  | 4172 | stli_brdstats.brd = brdp->brdnr; | 
|  | 4173 | stli_brdstats.type = brdp->brdtype; | 
|  | 4174 | stli_brdstats.hwid = 0; | 
|  | 4175 | stli_brdstats.state = brdp->state; | 
|  | 4176 | stli_brdstats.ioaddr = brdp->iobase; | 
|  | 4177 | stli_brdstats.memaddr = brdp->memaddr; | 
|  | 4178 | stli_brdstats.nrpanels = brdp->nrpanels; | 
|  | 4179 | stli_brdstats.nrports = brdp->nrports; | 
|  | 4180 | for (i = 0; (i < brdp->nrpanels); i++) { | 
|  | 4181 | stli_brdstats.panels[i].panel = i; | 
|  | 4182 | stli_brdstats.panels[i].hwid = brdp->panelids[i]; | 
|  | 4183 | stli_brdstats.panels[i].nrports = brdp->panels[i]; | 
|  | 4184 | } | 
|  | 4185 |  | 
|  | 4186 | if (copy_to_user(bp, &stli_brdstats, sizeof(combrd_t))) | 
|  | 4187 | return -EFAULT; | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 4188 | return 0; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 4189 | } | 
|  | 4190 |  | 
|  | 4191 | /*****************************************************************************/ | 
|  | 4192 |  | 
|  | 4193 | /* | 
|  | 4194 | *	Resolve the referenced port number into a port struct pointer. | 
|  | 4195 | */ | 
|  | 4196 |  | 
| Jiri Slaby | 1328d73 | 2006-12-08 02:39:19 -0800 | [diff] [blame] | 4197 | static struct stliport *stli_getport(unsigned int brdnr, unsigned int panelnr, | 
|  | 4198 | unsigned int portnr) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 4199 | { | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 4200 | struct stlibrd *brdp; | 
| Jiri Slaby | 1328d73 | 2006-12-08 02:39:19 -0800 | [diff] [blame] | 4201 | unsigned int i; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 4202 |  | 
| Jiri Slaby | 1328d73 | 2006-12-08 02:39:19 -0800 | [diff] [blame] | 4203 | if (brdnr >= STL_MAXBRDS) | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 4204 | return NULL; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 4205 | brdp = stli_brds[brdnr]; | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 4206 | if (brdp == NULL) | 
|  | 4207 | return NULL; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 4208 | for (i = 0; (i < panelnr); i++) | 
|  | 4209 | portnr += brdp->panels[i]; | 
| Jiri Slaby | 1328d73 | 2006-12-08 02:39:19 -0800 | [diff] [blame] | 4210 | if (portnr >= brdp->nrports) | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 4211 | return NULL; | 
|  | 4212 | return brdp->ports[portnr]; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 4213 | } | 
|  | 4214 |  | 
|  | 4215 | /*****************************************************************************/ | 
|  | 4216 |  | 
|  | 4217 | /* | 
|  | 4218 | *	Return the port stats structure to user app. A NULL port struct | 
|  | 4219 | *	pointer passed in means that we need to find out from the app | 
|  | 4220 | *	what port to get stats for (used through board control device). | 
|  | 4221 | */ | 
|  | 4222 |  | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 4223 | static int stli_portcmdstats(struct stliport *portp) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 4224 | { | 
|  | 4225 | unsigned long	flags; | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 4226 | struct stlibrd	*brdp; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 4227 | int		rc; | 
|  | 4228 |  | 
|  | 4229 | memset(&stli_comstats, 0, sizeof(comstats_t)); | 
|  | 4230 |  | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 4231 | if (portp == NULL) | 
|  | 4232 | return -ENODEV; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 4233 | brdp = stli_brds[portp->brdnr]; | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 4234 | if (brdp == NULL) | 
|  | 4235 | return -ENODEV; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 4236 |  | 
|  | 4237 | if (brdp->state & BST_STARTED) { | 
|  | 4238 | if ((rc = stli_cmdwait(brdp, portp, A_GETSTATS, | 
|  | 4239 | &stli_cdkstats, sizeof(asystats_t), 1)) < 0) | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 4240 | return rc; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 4241 | } else { | 
|  | 4242 | memset(&stli_cdkstats, 0, sizeof(asystats_t)); | 
|  | 4243 | } | 
|  | 4244 |  | 
|  | 4245 | stli_comstats.brd = portp->brdnr; | 
|  | 4246 | stli_comstats.panel = portp->panelnr; | 
|  | 4247 | stli_comstats.port = portp->portnr; | 
|  | 4248 | stli_comstats.state = portp->state; | 
|  | 4249 | stli_comstats.flags = portp->flags; | 
|  | 4250 |  | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 4251 | spin_lock_irqsave(&brd_lock, flags); | 
|  | 4252 | if (portp->tty != NULL) { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 4253 | if (portp->tty->driver_data == portp) { | 
|  | 4254 | stli_comstats.ttystate = portp->tty->flags; | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 4255 | stli_comstats.rxbuffered = -1; | 
|  | 4256 | if (portp->tty->termios != NULL) { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 4257 | stli_comstats.cflags = portp->tty->termios->c_cflag; | 
|  | 4258 | stli_comstats.iflags = portp->tty->termios->c_iflag; | 
|  | 4259 | stli_comstats.oflags = portp->tty->termios->c_oflag; | 
|  | 4260 | stli_comstats.lflags = portp->tty->termios->c_lflag; | 
|  | 4261 | } | 
|  | 4262 | } | 
|  | 4263 | } | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 4264 | spin_unlock_irqrestore(&brd_lock, flags); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 4265 |  | 
|  | 4266 | stli_comstats.txtotal = stli_cdkstats.txchars; | 
|  | 4267 | stli_comstats.rxtotal = stli_cdkstats.rxchars + stli_cdkstats.ringover; | 
|  | 4268 | stli_comstats.txbuffered = stli_cdkstats.txringq; | 
|  | 4269 | stli_comstats.rxbuffered += stli_cdkstats.rxringq; | 
|  | 4270 | stli_comstats.rxoverrun = stli_cdkstats.overruns; | 
|  | 4271 | stli_comstats.rxparity = stli_cdkstats.parity; | 
|  | 4272 | stli_comstats.rxframing = stli_cdkstats.framing; | 
|  | 4273 | stli_comstats.rxlost = stli_cdkstats.ringover; | 
|  | 4274 | stli_comstats.rxbreaks = stli_cdkstats.rxbreaks; | 
|  | 4275 | stli_comstats.txbreaks = stli_cdkstats.txbreaks; | 
|  | 4276 | stli_comstats.txxon = stli_cdkstats.txstart; | 
|  | 4277 | stli_comstats.txxoff = stli_cdkstats.txstop; | 
|  | 4278 | stli_comstats.rxxon = stli_cdkstats.rxstart; | 
|  | 4279 | stli_comstats.rxxoff = stli_cdkstats.rxstop; | 
|  | 4280 | stli_comstats.rxrtsoff = stli_cdkstats.rtscnt / 2; | 
|  | 4281 | stli_comstats.rxrtson = stli_cdkstats.rtscnt - stli_comstats.rxrtsoff; | 
|  | 4282 | stli_comstats.modem = stli_cdkstats.dcdcnt; | 
|  | 4283 | stli_comstats.hwid = stli_cdkstats.hwid; | 
|  | 4284 | stli_comstats.signals = stli_mktiocm(stli_cdkstats.signals); | 
|  | 4285 |  | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 4286 | return 0; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 4287 | } | 
|  | 4288 |  | 
|  | 4289 | /*****************************************************************************/ | 
|  | 4290 |  | 
|  | 4291 | /* | 
|  | 4292 | *	Return the port stats structure to user app. A NULL port struct | 
|  | 4293 | *	pointer passed in means that we need to find out from the app | 
|  | 4294 | *	what port to get stats for (used through board control device). | 
|  | 4295 | */ | 
|  | 4296 |  | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 4297 | static int stli_getportstats(struct stliport *portp, comstats_t __user *cp) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 4298 | { | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 4299 | struct stlibrd *brdp; | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 4300 | int rc; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 4301 |  | 
|  | 4302 | if (!portp) { | 
|  | 4303 | if (copy_from_user(&stli_comstats, cp, sizeof(comstats_t))) | 
|  | 4304 | return -EFAULT; | 
|  | 4305 | portp = stli_getport(stli_comstats.brd, stli_comstats.panel, | 
|  | 4306 | stli_comstats.port); | 
|  | 4307 | if (!portp) | 
|  | 4308 | return -ENODEV; | 
|  | 4309 | } | 
|  | 4310 |  | 
|  | 4311 | brdp = stli_brds[portp->brdnr]; | 
|  | 4312 | if (!brdp) | 
|  | 4313 | return -ENODEV; | 
|  | 4314 |  | 
|  | 4315 | if ((rc = stli_portcmdstats(portp)) < 0) | 
|  | 4316 | return rc; | 
|  | 4317 |  | 
|  | 4318 | return copy_to_user(cp, &stli_comstats, sizeof(comstats_t)) ? | 
|  | 4319 | -EFAULT : 0; | 
|  | 4320 | } | 
|  | 4321 |  | 
|  | 4322 | /*****************************************************************************/ | 
|  | 4323 |  | 
|  | 4324 | /* | 
|  | 4325 | *	Clear the port stats structure. We also return it zeroed out... | 
|  | 4326 | */ | 
|  | 4327 |  | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 4328 | static int stli_clrportstats(struct stliport *portp, comstats_t __user *cp) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 4329 | { | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 4330 | struct stlibrd *brdp; | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 4331 | int rc; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 4332 |  | 
|  | 4333 | if (!portp) { | 
|  | 4334 | if (copy_from_user(&stli_comstats, cp, sizeof(comstats_t))) | 
|  | 4335 | return -EFAULT; | 
|  | 4336 | portp = stli_getport(stli_comstats.brd, stli_comstats.panel, | 
|  | 4337 | stli_comstats.port); | 
|  | 4338 | if (!portp) | 
|  | 4339 | return -ENODEV; | 
|  | 4340 | } | 
|  | 4341 |  | 
|  | 4342 | brdp = stli_brds[portp->brdnr]; | 
|  | 4343 | if (!brdp) | 
|  | 4344 | return -ENODEV; | 
|  | 4345 |  | 
|  | 4346 | if (brdp->state & BST_STARTED) { | 
|  | 4347 | if ((rc = stli_cmdwait(brdp, portp, A_CLEARSTATS, NULL, 0, 0)) < 0) | 
|  | 4348 | return rc; | 
|  | 4349 | } | 
|  | 4350 |  | 
|  | 4351 | memset(&stli_comstats, 0, sizeof(comstats_t)); | 
|  | 4352 | stli_comstats.brd = portp->brdnr; | 
|  | 4353 | stli_comstats.panel = portp->panelnr; | 
|  | 4354 | stli_comstats.port = portp->portnr; | 
|  | 4355 |  | 
|  | 4356 | if (copy_to_user(cp, &stli_comstats, sizeof(comstats_t))) | 
|  | 4357 | return -EFAULT; | 
|  | 4358 | return 0; | 
|  | 4359 | } | 
|  | 4360 |  | 
|  | 4361 | /*****************************************************************************/ | 
|  | 4362 |  | 
|  | 4363 | /* | 
|  | 4364 | *	Return the entire driver ports structure to a user app. | 
|  | 4365 | */ | 
|  | 4366 |  | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 4367 | static int stli_getportstruct(struct stliport __user *arg) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 4368 | { | 
| Jiri Slaby | 1328d73 | 2006-12-08 02:39:19 -0800 | [diff] [blame] | 4369 | struct stliport stli_dummyport; | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 4370 | struct stliport *portp; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 4371 |  | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 4372 | if (copy_from_user(&stli_dummyport, arg, sizeof(struct stliport))) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 4373 | return -EFAULT; | 
|  | 4374 | portp = stli_getport(stli_dummyport.brdnr, stli_dummyport.panelnr, | 
|  | 4375 | stli_dummyport.portnr); | 
|  | 4376 | if (!portp) | 
|  | 4377 | return -ENODEV; | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 4378 | if (copy_to_user(arg, portp, sizeof(struct stliport))) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 4379 | return -EFAULT; | 
|  | 4380 | return 0; | 
|  | 4381 | } | 
|  | 4382 |  | 
|  | 4383 | /*****************************************************************************/ | 
|  | 4384 |  | 
|  | 4385 | /* | 
|  | 4386 | *	Return the entire driver board structure to a user app. | 
|  | 4387 | */ | 
|  | 4388 |  | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 4389 | static int stli_getbrdstruct(struct stlibrd __user *arg) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 4390 | { | 
| Jiri Slaby | 1328d73 | 2006-12-08 02:39:19 -0800 | [diff] [blame] | 4391 | struct stlibrd stli_dummybrd; | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 4392 | struct stlibrd *brdp; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 4393 |  | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 4394 | if (copy_from_user(&stli_dummybrd, arg, sizeof(struct stlibrd))) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 4395 | return -EFAULT; | 
| Jiri Slaby | 1328d73 | 2006-12-08 02:39:19 -0800 | [diff] [blame] | 4396 | if (stli_dummybrd.brdnr >= STL_MAXBRDS) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 4397 | return -ENODEV; | 
|  | 4398 | brdp = stli_brds[stli_dummybrd.brdnr]; | 
|  | 4399 | if (!brdp) | 
|  | 4400 | return -ENODEV; | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 4401 | if (copy_to_user(arg, brdp, sizeof(struct stlibrd))) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 4402 | return -EFAULT; | 
|  | 4403 | return 0; | 
|  | 4404 | } | 
|  | 4405 |  | 
|  | 4406 | /*****************************************************************************/ | 
|  | 4407 |  | 
|  | 4408 | /* | 
|  | 4409 | *	The "staliomem" device is also required to do some special operations on | 
|  | 4410 | *	the board. We need to be able to send an interrupt to the board, | 
|  | 4411 | *	reset it, and start/stop it. | 
|  | 4412 | */ | 
|  | 4413 |  | 
|  | 4414 | static int stli_memioctl(struct inode *ip, struct file *fp, unsigned int cmd, unsigned long arg) | 
|  | 4415 | { | 
| Jiri Slaby | 1f8ec43 | 2006-12-08 02:39:18 -0800 | [diff] [blame] | 4416 | struct stlibrd *brdp; | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 4417 | int brdnr, rc, done; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 4418 | void __user *argp = (void __user *)arg; | 
|  | 4419 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 4420 | /* | 
|  | 4421 | *	First up handle the board independent ioctls. | 
|  | 4422 | */ | 
|  | 4423 | done = 0; | 
|  | 4424 | rc = 0; | 
|  | 4425 |  | 
| Alan Cox | 3736113 | 2008-04-30 00:53:19 -0700 | [diff] [blame] | 4426 | lock_kernel(); | 
|  | 4427 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 4428 | switch (cmd) { | 
|  | 4429 | case COM_GETPORTSTATS: | 
|  | 4430 | rc = stli_getportstats(NULL, argp); | 
|  | 4431 | done++; | 
|  | 4432 | break; | 
|  | 4433 | case COM_CLRPORTSTATS: | 
|  | 4434 | rc = stli_clrportstats(NULL, argp); | 
|  | 4435 | done++; | 
|  | 4436 | break; | 
|  | 4437 | case COM_GETBRDSTATS: | 
|  | 4438 | rc = stli_getbrdstats(argp); | 
|  | 4439 | done++; | 
|  | 4440 | break; | 
|  | 4441 | case COM_READPORT: | 
|  | 4442 | rc = stli_getportstruct(argp); | 
|  | 4443 | done++; | 
|  | 4444 | break; | 
|  | 4445 | case COM_READBOARD: | 
|  | 4446 | rc = stli_getbrdstruct(argp); | 
|  | 4447 | done++; | 
|  | 4448 | break; | 
|  | 4449 | } | 
| Alan Cox | 3736113 | 2008-04-30 00:53:19 -0700 | [diff] [blame] | 4450 | unlock_kernel(); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 4451 |  | 
|  | 4452 | if (done) | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 4453 | return rc; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 4454 |  | 
|  | 4455 | /* | 
|  | 4456 | *	Now handle the board specific ioctls. These all depend on the | 
|  | 4457 | *	minor number of the device they were called from. | 
|  | 4458 | */ | 
|  | 4459 | brdnr = iminor(ip); | 
|  | 4460 | if (brdnr >= STL_MAXBRDS) | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 4461 | return -ENODEV; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 4462 | brdp = stli_brds[brdnr]; | 
|  | 4463 | if (!brdp) | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 4464 | return -ENODEV; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 4465 | if (brdp->state == 0) | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 4466 | return -ENODEV; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 4467 |  | 
| Alan Cox | 3736113 | 2008-04-30 00:53:19 -0700 | [diff] [blame] | 4468 | lock_kernel(); | 
|  | 4469 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 4470 | switch (cmd) { | 
|  | 4471 | case STL_BINTR: | 
|  | 4472 | EBRDINTR(brdp); | 
|  | 4473 | break; | 
|  | 4474 | case STL_BSTART: | 
|  | 4475 | rc = stli_startbrd(brdp); | 
|  | 4476 | break; | 
|  | 4477 | case STL_BSTOP: | 
|  | 4478 | brdp->state &= ~BST_STARTED; | 
|  | 4479 | break; | 
|  | 4480 | case STL_BRESET: | 
|  | 4481 | brdp->state &= ~BST_STARTED; | 
|  | 4482 | EBRDRESET(brdp); | 
|  | 4483 | if (stli_shared == 0) { | 
|  | 4484 | if (brdp->reenable != NULL) | 
|  | 4485 | (* brdp->reenable)(brdp); | 
|  | 4486 | } | 
|  | 4487 | break; | 
|  | 4488 | default: | 
|  | 4489 | rc = -ENOIOCTLCMD; | 
|  | 4490 | break; | 
|  | 4491 | } | 
| Alan Cox | 3736113 | 2008-04-30 00:53:19 -0700 | [diff] [blame] | 4492 | unlock_kernel(); | 
| Alan Cox | 4ac4360 | 2006-06-28 04:26:52 -0700 | [diff] [blame] | 4493 | return rc; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 4494 | } | 
|  | 4495 |  | 
| Jeff Dike | b68e31d | 2006-10-02 02:17:18 -0700 | [diff] [blame] | 4496 | static const struct tty_operations stli_ops = { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 4497 | .open = stli_open, | 
|  | 4498 | .close = stli_close, | 
|  | 4499 | .write = stli_write, | 
|  | 4500 | .put_char = stli_putchar, | 
|  | 4501 | .flush_chars = stli_flushchars, | 
|  | 4502 | .write_room = stli_writeroom, | 
|  | 4503 | .chars_in_buffer = stli_charsinbuffer, | 
|  | 4504 | .ioctl = stli_ioctl, | 
|  | 4505 | .set_termios = stli_settermios, | 
|  | 4506 | .throttle = stli_throttle, | 
|  | 4507 | .unthrottle = stli_unthrottle, | 
|  | 4508 | .stop = stli_stop, | 
|  | 4509 | .start = stli_start, | 
|  | 4510 | .hangup = stli_hangup, | 
|  | 4511 | .flush_buffer = stli_flushbuffer, | 
|  | 4512 | .break_ctl = stli_breakctl, | 
|  | 4513 | .wait_until_sent = stli_waituntilsent, | 
|  | 4514 | .send_xchar = stli_sendxchar, | 
|  | 4515 | .read_proc = stli_readproc, | 
|  | 4516 | .tiocmget = stli_tiocmget, | 
|  | 4517 | .tiocmset = stli_tiocmset, | 
|  | 4518 | }; | 
|  | 4519 |  | 
|  | 4520 | /*****************************************************************************/ | 
| Jiri Slaby | f1cc54f | 2006-12-08 02:39:24 -0800 | [diff] [blame] | 4521 | /* | 
|  | 4522 | *	Loadable module initialization stuff. | 
|  | 4523 | */ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 4524 |  | 
| Jiri Slaby | f2362c9 | 2006-12-08 02:39:25 -0800 | [diff] [blame] | 4525 | static void istallion_cleanup_isa(void) | 
| Jiri Slaby | f1cc54f | 2006-12-08 02:39:24 -0800 | [diff] [blame] | 4526 | { | 
|  | 4527 | struct stlibrd	*brdp; | 
|  | 4528 | unsigned int j; | 
| Jiri Slaby | f1cc54f | 2006-12-08 02:39:24 -0800 | [diff] [blame] | 4529 |  | 
|  | 4530 | for (j = 0; (j < stli_nrbrds); j++) { | 
|  | 4531 | if ((brdp = stli_brds[j]) == NULL || (brdp->state & BST_PROBED)) | 
|  | 4532 | continue; | 
|  | 4533 |  | 
|  | 4534 | stli_cleanup_ports(brdp); | 
|  | 4535 |  | 
|  | 4536 | iounmap(brdp->membase); | 
|  | 4537 | if (brdp->iosize > 0) | 
|  | 4538 | release_region(brdp->iobase, brdp->iosize); | 
|  | 4539 | kfree(brdp); | 
|  | 4540 | stli_brds[j] = NULL; | 
|  | 4541 | } | 
|  | 4542 | } | 
|  | 4543 |  | 
| Jiri Slaby | f2362c9 | 2006-12-08 02:39:25 -0800 | [diff] [blame] | 4544 | static int __init istallion_module_init(void) | 
|  | 4545 | { | 
|  | 4546 | unsigned int i; | 
|  | 4547 | int retval; | 
|  | 4548 |  | 
|  | 4549 | printk(KERN_INFO "%s: version %s\n", stli_drvtitle, stli_drvversion); | 
|  | 4550 |  | 
|  | 4551 | spin_lock_init(&stli_lock); | 
|  | 4552 | spin_lock_init(&brd_lock); | 
|  | 4553 |  | 
|  | 4554 | stli_txcookbuf = kmalloc(STLI_TXBUFSIZE, GFP_KERNEL); | 
|  | 4555 | if (!stli_txcookbuf) { | 
|  | 4556 | printk(KERN_ERR "STALLION: failed to allocate memory " | 
|  | 4557 | "(size=%d)\n", STLI_TXBUFSIZE); | 
|  | 4558 | retval = -ENOMEM; | 
|  | 4559 | goto err; | 
|  | 4560 | } | 
|  | 4561 |  | 
|  | 4562 | stli_serial = alloc_tty_driver(STL_MAXBRDS * STL_MAXPORTS); | 
|  | 4563 | if (!stli_serial) { | 
|  | 4564 | retval = -ENOMEM; | 
|  | 4565 | goto err_free; | 
|  | 4566 | } | 
|  | 4567 |  | 
|  | 4568 | stli_serial->owner = THIS_MODULE; | 
|  | 4569 | stli_serial->driver_name = stli_drvname; | 
|  | 4570 | stli_serial->name = stli_serialname; | 
|  | 4571 | stli_serial->major = STL_SERIALMAJOR; | 
|  | 4572 | stli_serial->minor_start = 0; | 
|  | 4573 | stli_serial->type = TTY_DRIVER_TYPE_SERIAL; | 
|  | 4574 | stli_serial->subtype = SERIAL_TYPE_NORMAL; | 
|  | 4575 | stli_serial->init_termios = stli_deftermios; | 
| Jiri Slaby | ec3dde5 | 2006-12-08 02:39:26 -0800 | [diff] [blame] | 4576 | stli_serial->flags = TTY_DRIVER_REAL_RAW | TTY_DRIVER_DYNAMIC_DEV; | 
| Jiri Slaby | f2362c9 | 2006-12-08 02:39:25 -0800 | [diff] [blame] | 4577 | tty_set_operations(stli_serial, &stli_ops); | 
|  | 4578 |  | 
|  | 4579 | retval = tty_register_driver(stli_serial); | 
|  | 4580 | if (retval) { | 
|  | 4581 | printk(KERN_ERR "STALLION: failed to register serial driver\n"); | 
|  | 4582 | goto err_ttyput; | 
|  | 4583 | } | 
|  | 4584 |  | 
|  | 4585 | retval = stli_initbrds(); | 
|  | 4586 | if (retval) | 
|  | 4587 | goto err_ttyunr; | 
|  | 4588 |  | 
|  | 4589 | /* | 
|  | 4590 | *	Set up a character driver for the shared memory region. We need this | 
|  | 4591 | *	to down load the slave code image. Also it is a useful debugging tool. | 
|  | 4592 | */ | 
|  | 4593 | retval = register_chrdev(STL_SIOMEMMAJOR, "staliomem", &stli_fsiomem); | 
|  | 4594 | if (retval) { | 
|  | 4595 | printk(KERN_ERR "STALLION: failed to register serial memory " | 
|  | 4596 | "device\n"); | 
|  | 4597 | goto err_deinit; | 
|  | 4598 | } | 
|  | 4599 |  | 
|  | 4600 | istallion_class = class_create(THIS_MODULE, "staliomem"); | 
|  | 4601 | for (i = 0; i < 4; i++) | 
| tonyj@suse.de | 07c015e | 2007-08-07 22:28:44 -0700 | [diff] [blame] | 4602 | device_create(istallion_class, NULL, MKDEV(STL_SIOMEMMAJOR, i), | 
|  | 4603 | "staliomem%d", i); | 
| Jiri Slaby | f2362c9 | 2006-12-08 02:39:25 -0800 | [diff] [blame] | 4604 |  | 
|  | 4605 | return 0; | 
|  | 4606 | err_deinit: | 
|  | 4607 | pci_unregister_driver(&stli_pcidriver); | 
|  | 4608 | istallion_cleanup_isa(); | 
|  | 4609 | err_ttyunr: | 
|  | 4610 | tty_unregister_driver(stli_serial); | 
|  | 4611 | err_ttyput: | 
|  | 4612 | put_tty_driver(stli_serial); | 
|  | 4613 | err_free: | 
|  | 4614 | kfree(stli_txcookbuf); | 
|  | 4615 | err: | 
|  | 4616 | return retval; | 
|  | 4617 | } | 
|  | 4618 |  | 
|  | 4619 | /*****************************************************************************/ | 
|  | 4620 |  | 
|  | 4621 | static void __exit istallion_module_exit(void) | 
|  | 4622 | { | 
|  | 4623 | unsigned int j; | 
|  | 4624 |  | 
|  | 4625 | printk(KERN_INFO "Unloading %s: version %s\n", stli_drvtitle, | 
|  | 4626 | stli_drvversion); | 
|  | 4627 |  | 
|  | 4628 | if (stli_timeron) { | 
|  | 4629 | stli_timeron = 0; | 
|  | 4630 | del_timer_sync(&stli_timerlist); | 
|  | 4631 | } | 
|  | 4632 |  | 
|  | 4633 | unregister_chrdev(STL_SIOMEMMAJOR, "staliomem"); | 
|  | 4634 |  | 
|  | 4635 | for (j = 0; j < 4; j++) | 
| tonyj@suse.de | 07c015e | 2007-08-07 22:28:44 -0700 | [diff] [blame] | 4636 | device_destroy(istallion_class, MKDEV(STL_SIOMEMMAJOR, j)); | 
| Jiri Slaby | f2362c9 | 2006-12-08 02:39:25 -0800 | [diff] [blame] | 4637 | class_destroy(istallion_class); | 
|  | 4638 |  | 
|  | 4639 | pci_unregister_driver(&stli_pcidriver); | 
|  | 4640 | istallion_cleanup_isa(); | 
|  | 4641 |  | 
|  | 4642 | tty_unregister_driver(stli_serial); | 
|  | 4643 | put_tty_driver(stli_serial); | 
|  | 4644 |  | 
|  | 4645 | kfree(stli_txcookbuf); | 
|  | 4646 | } | 
|  | 4647 |  | 
| Jiri Slaby | f1cc54f | 2006-12-08 02:39:24 -0800 | [diff] [blame] | 4648 | module_init(istallion_module_init); | 
|  | 4649 | module_exit(istallion_module_exit); |