| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1 | /* | 
|  | 2 | * Edgeport USB Serial Converter driver | 
|  | 3 | * | 
|  | 4 | * Copyright (C) 2000-2002 Inside Out Networks, All rights reserved. | 
|  | 5 | * Copyright (C) 2001-2002 Greg Kroah-Hartman <greg@kroah.com> | 
|  | 6 | * | 
|  | 7 | *	This program is free software; you can redistribute it and/or modify | 
|  | 8 | *	it under the terms of the GNU General Public License as published by | 
|  | 9 | *	the Free Software Foundation; either version 2 of the License, or | 
|  | 10 | *	(at your option) any later version. | 
|  | 11 | * | 
|  | 12 | * Supports the following devices: | 
|  | 13 | *	EP/1 EP/2 EP/4 EP/21 EP/22 EP/221 EP/42 EP/421 WATCHPORT | 
|  | 14 | * | 
|  | 15 | * For questions or problems with this driver, contact Inside Out | 
|  | 16 | * Networks technical support, or Peter Berger <pberger@brimson.com>, | 
|  | 17 | * or Al Borchers <alborchers@steinerpoint.com>. | 
|  | 18 | * | 
|  | 19 | * Version history: | 
|  | 20 | * | 
|  | 21 | *	July 11, 2002 	Removed 4 port device structure since all TI UMP | 
|  | 22 | *			chips have only 2 ports | 
|  | 23 | *			David Iacovelli (davidi@ionetworks.com) | 
|  | 24 | * | 
|  | 25 | */ | 
|  | 26 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 27 | #include <linux/kernel.h> | 
|  | 28 | #include <linux/jiffies.h> | 
|  | 29 | #include <linux/errno.h> | 
|  | 30 | #include <linux/init.h> | 
|  | 31 | #include <linux/slab.h> | 
|  | 32 | #include <linux/tty.h> | 
|  | 33 | #include <linux/tty_driver.h> | 
|  | 34 | #include <linux/tty_flip.h> | 
|  | 35 | #include <linux/module.h> | 
|  | 36 | #include <linux/spinlock.h> | 
| Matthias Kaehlcke | 241ca64 | 2007-12-04 16:15:40 +0100 | [diff] [blame] | 37 | #include <linux/mutex.h> | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 38 | #include <linux/serial.h> | 
|  | 39 | #include <linux/ioctl.h> | 
|  | 40 | #include <asm/uaccess.h> | 
|  | 41 | #include <asm/semaphore.h> | 
|  | 42 | #include <linux/usb.h> | 
| Greg Kroah-Hartman | a969888 | 2006-07-11 21:22:58 -0700 | [diff] [blame] | 43 | #include <linux/usb/serial.h> | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 44 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 45 | #include "io_16654.h" | 
|  | 46 | #include "io_usbvend.h" | 
|  | 47 | #include "io_ti.h" | 
|  | 48 |  | 
|  | 49 | /* | 
|  | 50 | * Version Information | 
|  | 51 | */ | 
| Martin K. Petersen | fc4cbd7 | 2007-05-22 15:57:04 -0400 | [diff] [blame] | 52 | #define DRIVER_VERSION "v0.7mode043006" | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 53 | #define DRIVER_AUTHOR "Greg Kroah-Hartman <greg@kroah.com> and David Iacovelli" | 
|  | 54 | #define DRIVER_DESC "Edgeport USB Serial Driver" | 
|  | 55 |  | 
|  | 56 |  | 
|  | 57 | /* firmware image code */ | 
|  | 58 | #define IMAGE_VERSION_NAME	PagableOperationalCodeImageVersion | 
|  | 59 | #define IMAGE_ARRAY_NAME	PagableOperationalCodeImage | 
|  | 60 | #define IMAGE_SIZE		PagableOperationalCodeSize | 
|  | 61 | #include "io_fw_down3.h"	/* Define array OperationalCodeImage[] */ | 
|  | 62 |  | 
|  | 63 | #define EPROM_PAGE_SIZE		64 | 
|  | 64 |  | 
|  | 65 |  | 
|  | 66 | struct edgeport_uart_buf_desc { | 
|  | 67 | __u32 count;		// Number of bytes currently in buffer | 
|  | 68 | }; | 
|  | 69 |  | 
|  | 70 | /* different hardware types */ | 
|  | 71 | #define HARDWARE_TYPE_930	0 | 
|  | 72 | #define HARDWARE_TYPE_TIUMP	1 | 
|  | 73 |  | 
|  | 74 | // IOCTL_PRIVATE_TI_GET_MODE Definitions | 
|  | 75 | #define	TI_MODE_CONFIGURING	0   // Device has not entered start device | 
|  | 76 | #define	TI_MODE_BOOT		1   // Staying in boot mode | 
|  | 77 | #define TI_MODE_DOWNLOAD	2   // Made it to download mode | 
|  | 78 | #define TI_MODE_TRANSITIONING	3   // Currently in boot mode but transitioning to download mode | 
|  | 79 |  | 
|  | 80 | /* read urb state */ | 
|  | 81 | #define EDGE_READ_URB_RUNNING	0 | 
|  | 82 | #define EDGE_READ_URB_STOPPING	1 | 
|  | 83 | #define EDGE_READ_URB_STOPPED	2 | 
|  | 84 |  | 
|  | 85 | #define EDGE_LOW_LATENCY	1 | 
|  | 86 | #define EDGE_CLOSING_WAIT	4000	/* in .01 sec */ | 
|  | 87 |  | 
|  | 88 | #define EDGE_OUT_BUF_SIZE	1024 | 
|  | 89 |  | 
|  | 90 |  | 
|  | 91 | /* Product information read from the Edgeport */ | 
|  | 92 | struct product_info | 
|  | 93 | { | 
|  | 94 | int	TiMode;			// Current TI Mode | 
|  | 95 | __u8	hardware_type;		// Type of hardware | 
|  | 96 | } __attribute__((packed)); | 
|  | 97 |  | 
|  | 98 | /* circular buffer */ | 
|  | 99 | struct edge_buf { | 
|  | 100 | unsigned int	buf_size; | 
|  | 101 | char		*buf_buf; | 
|  | 102 | char		*buf_get; | 
|  | 103 | char		*buf_put; | 
|  | 104 | }; | 
|  | 105 |  | 
|  | 106 | struct edgeport_port { | 
|  | 107 | __u16 uart_base; | 
|  | 108 | __u16 dma_address; | 
|  | 109 | __u8 shadow_msr; | 
|  | 110 | __u8 shadow_mcr; | 
|  | 111 | __u8 shadow_lsr; | 
|  | 112 | __u8 lsr_mask; | 
|  | 113 | __u32 ump_read_timeout;		/* Number of miliseconds the UMP will | 
|  | 114 | wait without data before completing | 
|  | 115 | a read short */ | 
|  | 116 | int baud_rate; | 
|  | 117 | int close_pending; | 
|  | 118 | int lsr_event; | 
|  | 119 | struct edgeport_uart_buf_desc tx; | 
|  | 120 | struct async_icount	icount; | 
|  | 121 | wait_queue_head_t	delta_msr_wait;	/* for handling sleeping while | 
|  | 122 | waiting for msr change to | 
|  | 123 | happen */ | 
|  | 124 | struct edgeport_serial	*edge_serial; | 
|  | 125 | struct usb_serial_port	*port; | 
|  | 126 | __u8 bUartMode;		/* Port type, 0: RS232, etc. */ | 
|  | 127 | spinlock_t ep_lock; | 
|  | 128 | int ep_read_urb_state; | 
|  | 129 | int ep_write_urb_in_use; | 
|  | 130 | struct edge_buf *ep_out_buf; | 
|  | 131 | }; | 
|  | 132 |  | 
|  | 133 | struct edgeport_serial { | 
|  | 134 | struct product_info product_info; | 
|  | 135 | u8 TI_I2C_Type;			// Type of I2C in UMP | 
|  | 136 | u8 TiReadI2C;			// Set to TRUE if we have read the I2c in Boot Mode | 
| Matthias Kaehlcke | 241ca64 | 2007-12-04 16:15:40 +0100 | [diff] [blame] | 137 | struct mutex es_lock; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 138 | int num_ports_open; | 
|  | 139 | struct usb_serial *serial; | 
|  | 140 | }; | 
|  | 141 |  | 
|  | 142 |  | 
|  | 143 | /* Devices that this driver supports */ | 
|  | 144 | static struct usb_device_id edgeport_1port_id_table [] = { | 
|  | 145 | { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_TI_EDGEPORT_1) }, | 
|  | 146 | { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_TI_TI3410_EDGEPORT_1) }, | 
|  | 147 | { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_TI_TI3410_EDGEPORT_1I) }, | 
|  | 148 | { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_WP_PROXIMITY) }, | 
|  | 149 | { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_WP_MOTION) }, | 
|  | 150 | { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_WP_MOISTURE) }, | 
|  | 151 | { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_WP_TEMPERATURE) }, | 
|  | 152 | { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_WP_HUMIDITY) }, | 
|  | 153 | { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_WP_POWER) }, | 
|  | 154 | { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_WP_LIGHT) }, | 
|  | 155 | { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_WP_RADIATION) }, | 
|  | 156 | { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_WP_DISTANCE) }, | 
|  | 157 | { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_WP_ACCELERATION) }, | 
|  | 158 | { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_WP_PROX_DIST) }, | 
|  | 159 | { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_PLUS_PWR_HP4CD) }, | 
|  | 160 | { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_PLUS_PWR_PCI) }, | 
|  | 161 | { } | 
|  | 162 | }; | 
|  | 163 |  | 
|  | 164 | static struct usb_device_id edgeport_2port_id_table [] = { | 
|  | 165 | { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_TI_EDGEPORT_2) }, | 
|  | 166 | { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_TI_EDGEPORT_2C) }, | 
|  | 167 | { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_TI_EDGEPORT_2I) }, | 
|  | 168 | { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_TI_EDGEPORT_421) }, | 
|  | 169 | { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_TI_EDGEPORT_21) }, | 
|  | 170 | { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_TI_EDGEPORT_42) }, | 
|  | 171 | { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_TI_EDGEPORT_4) }, | 
|  | 172 | { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_TI_EDGEPORT_4I) }, | 
|  | 173 | { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_TI_EDGEPORT_22I) }, | 
|  | 174 | { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_TI_EDGEPORT_221C) }, | 
|  | 175 | { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_TI_EDGEPORT_22C) }, | 
|  | 176 | { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_TI_EDGEPORT_21C) }, | 
| Martin K. Petersen | fc4cbd7 | 2007-05-22 15:57:04 -0400 | [diff] [blame] | 177 | /* The 4, 8 and 16 port devices show up as multiple 2 port devices */ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 178 | { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_TI_EDGEPORT_4S) }, | 
| Martin K. Petersen | fc4cbd7 | 2007-05-22 15:57:04 -0400 | [diff] [blame] | 179 | { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_TI_EDGEPORT_8) }, | 
|  | 180 | { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_TI_EDGEPORT_8S) }, | 
|  | 181 | { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_TI_EDGEPORT_416) }, | 
|  | 182 | { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_TI_EDGEPORT_416B) }, | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 183 | { } | 
|  | 184 | }; | 
|  | 185 |  | 
|  | 186 | /* Devices that this driver supports */ | 
|  | 187 | static struct usb_device_id id_table_combined [] = { | 
|  | 188 | { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_TI_EDGEPORT_1) }, | 
|  | 189 | { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_TI_TI3410_EDGEPORT_1) }, | 
|  | 190 | { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_TI_TI3410_EDGEPORT_1I) }, | 
|  | 191 | { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_WP_PROXIMITY) }, | 
|  | 192 | { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_WP_MOTION) }, | 
|  | 193 | { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_WP_MOISTURE) }, | 
|  | 194 | { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_WP_TEMPERATURE) }, | 
|  | 195 | { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_WP_HUMIDITY) }, | 
|  | 196 | { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_WP_POWER) }, | 
|  | 197 | { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_WP_LIGHT) }, | 
|  | 198 | { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_WP_RADIATION) }, | 
|  | 199 | { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_WP_DISTANCE) }, | 
|  | 200 | { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_WP_ACCELERATION) }, | 
|  | 201 | { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_WP_PROX_DIST) }, | 
|  | 202 | { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_PLUS_PWR_HP4CD) }, | 
|  | 203 | { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_PLUS_PWR_PCI) }, | 
|  | 204 | { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_TI_EDGEPORT_2) }, | 
|  | 205 | { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_TI_EDGEPORT_2C) }, | 
|  | 206 | { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_TI_EDGEPORT_2I) }, | 
|  | 207 | { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_TI_EDGEPORT_421) }, | 
|  | 208 | { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_TI_EDGEPORT_21) }, | 
|  | 209 | { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_TI_EDGEPORT_42) }, | 
|  | 210 | { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_TI_EDGEPORT_4) }, | 
|  | 211 | { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_TI_EDGEPORT_4I) }, | 
|  | 212 | { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_TI_EDGEPORT_22I) }, | 
|  | 213 | { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_TI_EDGEPORT_221C) }, | 
|  | 214 | { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_TI_EDGEPORT_22C) }, | 
|  | 215 | { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_TI_EDGEPORT_21C) }, | 
|  | 216 | { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_TI_EDGEPORT_4S) }, | 
| Martin K. Petersen | fc4cbd7 | 2007-05-22 15:57:04 -0400 | [diff] [blame] | 217 | { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_TI_EDGEPORT_8) }, | 
|  | 218 | { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_TI_EDGEPORT_8S) }, | 
|  | 219 | { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_TI_EDGEPORT_416) }, | 
|  | 220 | { USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_TI_EDGEPORT_416B) }, | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 221 | { } | 
|  | 222 | }; | 
|  | 223 |  | 
|  | 224 | MODULE_DEVICE_TABLE (usb, id_table_combined); | 
|  | 225 |  | 
|  | 226 | static struct usb_driver io_driver = { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 227 | .name =		"io_ti", | 
|  | 228 | .probe =	usb_serial_probe, | 
|  | 229 | .disconnect =	usb_serial_disconnect, | 
|  | 230 | .id_table =	id_table_combined, | 
| Greg Kroah-Hartman | ba9dc65 | 2005-11-16 13:41:28 -0800 | [diff] [blame] | 231 | .no_dynamic_id = 	1, | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 232 | }; | 
|  | 233 |  | 
|  | 234 |  | 
|  | 235 | static struct EDGE_FIRMWARE_VERSION_INFO OperationalCodeImageVersion; | 
|  | 236 |  | 
|  | 237 | static int debug; | 
|  | 238 |  | 
|  | 239 | static int TIStayInBootMode = 0; | 
|  | 240 | static int low_latency = EDGE_LOW_LATENCY; | 
|  | 241 | static int closing_wait = EDGE_CLOSING_WAIT; | 
|  | 242 | static int ignore_cpu_rev = 0; | 
| Martin K. Petersen | fc4cbd7 | 2007-05-22 15:57:04 -0400 | [diff] [blame] | 243 | static int default_uart_mode = 0;	/* RS232 */ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 244 |  | 
|  | 245 |  | 
|  | 246 | static void edge_tty_recv(struct device *dev, struct tty_struct *tty, unsigned char *data, int length); | 
|  | 247 |  | 
|  | 248 | static void stop_read(struct edgeport_port *edge_port); | 
|  | 249 | static int restart_read(struct edgeport_port *edge_port); | 
|  | 250 |  | 
| Alan Cox | 606d099 | 2006-12-08 02:38:45 -0800 | [diff] [blame] | 251 | static void edge_set_termios (struct usb_serial_port *port, struct ktermios *old_termios); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 252 | static void edge_send(struct usb_serial_port *port); | 
|  | 253 |  | 
| Martin K. Petersen | fc4cbd7 | 2007-05-22 15:57:04 -0400 | [diff] [blame] | 254 | /* sysfs attributes */ | 
|  | 255 | static int edge_create_sysfs_attrs(struct usb_serial_port *port); | 
|  | 256 | static int edge_remove_sysfs_attrs(struct usb_serial_port *port); | 
|  | 257 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 258 | /* circular buffer */ | 
|  | 259 | static struct edge_buf *edge_buf_alloc(unsigned int size); | 
|  | 260 | static void edge_buf_free(struct edge_buf *eb); | 
|  | 261 | static void edge_buf_clear(struct edge_buf *eb); | 
|  | 262 | static unsigned int edge_buf_data_avail(struct edge_buf *eb); | 
|  | 263 | static unsigned int edge_buf_space_avail(struct edge_buf *eb); | 
|  | 264 | static unsigned int edge_buf_put(struct edge_buf *eb, const char *buf, | 
|  | 265 | unsigned int count); | 
|  | 266 | static unsigned int edge_buf_get(struct edge_buf *eb, char *buf, | 
|  | 267 | unsigned int count); | 
|  | 268 |  | 
|  | 269 |  | 
|  | 270 | static int TIReadVendorRequestSync (struct usb_device *dev, | 
|  | 271 | __u8		request, | 
|  | 272 | __u16		value, | 
|  | 273 | __u16		index, | 
|  | 274 | u8 		*data, | 
|  | 275 | int		size) | 
|  | 276 | { | 
|  | 277 | int status; | 
|  | 278 |  | 
|  | 279 | status = usb_control_msg (dev, | 
|  | 280 | usb_rcvctrlpipe(dev, 0), | 
|  | 281 | request, | 
|  | 282 | (USB_TYPE_VENDOR | | 
|  | 283 | USB_RECIP_DEVICE | | 
|  | 284 | USB_DIR_IN), | 
|  | 285 | value, | 
|  | 286 | index, | 
|  | 287 | data, | 
|  | 288 | size, | 
|  | 289 | 1000); | 
|  | 290 | if (status < 0) | 
|  | 291 | return status; | 
|  | 292 | if (status != size) { | 
|  | 293 | dbg ("%s - wanted to write %d, but only wrote %d", | 
|  | 294 | __FUNCTION__, size, status); | 
|  | 295 | return -ECOMM; | 
|  | 296 | } | 
|  | 297 | return 0; | 
|  | 298 | } | 
|  | 299 |  | 
|  | 300 | static int TISendVendorRequestSync (struct usb_device *dev, | 
|  | 301 | __u8		request, | 
|  | 302 | __u16		value, | 
|  | 303 | __u16		index, | 
|  | 304 | u8 		*data, | 
|  | 305 | int		size) | 
|  | 306 | { | 
|  | 307 | int status; | 
|  | 308 |  | 
|  | 309 | status = usb_control_msg (dev, | 
|  | 310 | usb_sndctrlpipe(dev, 0), | 
|  | 311 | request, | 
|  | 312 | (USB_TYPE_VENDOR | | 
|  | 313 | USB_RECIP_DEVICE | | 
|  | 314 | USB_DIR_OUT), | 
|  | 315 | value, | 
|  | 316 | index, | 
|  | 317 | data, | 
|  | 318 | size, | 
|  | 319 | 1000); | 
|  | 320 | if (status < 0) | 
|  | 321 | return status; | 
|  | 322 | if (status != size) { | 
|  | 323 | dbg ("%s - wanted to write %d, but only wrote %d", | 
|  | 324 | __FUNCTION__, size, status); | 
|  | 325 | return -ECOMM; | 
|  | 326 | } | 
|  | 327 | return 0; | 
|  | 328 | } | 
|  | 329 |  | 
|  | 330 | static int TIWriteCommandSync (struct usb_device *dev, __u8 command, | 
|  | 331 | __u8 moduleid, __u16 value, u8 *data, | 
|  | 332 | int size) | 
|  | 333 | { | 
|  | 334 | return TISendVendorRequestSync (dev, | 
|  | 335 | command,	  		// Request | 
|  | 336 | value,			// wValue | 
|  | 337 | moduleid,			// wIndex | 
|  | 338 | data,				// TransferBuffer | 
|  | 339 | size);			// TransferBufferLength | 
|  | 340 |  | 
|  | 341 | } | 
|  | 342 |  | 
|  | 343 | /* clear tx/rx buffers and fifo in TI UMP */ | 
|  | 344 | static int TIPurgeDataSync (struct usb_serial_port *port, __u16 mask) | 
|  | 345 | { | 
|  | 346 | int port_number = port->number - port->serial->minor; | 
|  | 347 |  | 
|  | 348 | dbg ("%s - port %d, mask %x", __FUNCTION__, port_number, mask); | 
|  | 349 |  | 
|  | 350 | return TIWriteCommandSync (port->serial->dev, | 
|  | 351 | UMPC_PURGE_PORT, | 
|  | 352 | (__u8)(UMPM_UART1_PORT + port_number), | 
|  | 353 | mask, | 
|  | 354 | NULL, | 
|  | 355 | 0); | 
|  | 356 | } | 
|  | 357 |  | 
|  | 358 | /** | 
|  | 359 | * TIReadDownloadMemory - Read edgeport memory from TI chip | 
|  | 360 | * @dev: usb device pointer | 
|  | 361 | * @start_address: Device CPU address at which to read | 
|  | 362 | * @length: Length of above data | 
|  | 363 | * @address_type: Can read both XDATA and I2C | 
|  | 364 | * @buffer: pointer to input data buffer | 
|  | 365 | */ | 
|  | 366 | static int TIReadDownloadMemory(struct usb_device *dev, int start_address, | 
|  | 367 | int length, __u8 address_type, __u8 *buffer) | 
|  | 368 | { | 
|  | 369 | int status = 0; | 
|  | 370 | __u8 read_length; | 
|  | 371 | __be16 be_start_address; | 
|  | 372 |  | 
|  | 373 | dbg ("%s - @ %x for %d", __FUNCTION__, start_address, length); | 
|  | 374 |  | 
|  | 375 | /* Read in blocks of 64 bytes | 
|  | 376 | * (TI firmware can't handle more than 64 byte reads) | 
|  | 377 | */ | 
|  | 378 | while (length) { | 
|  | 379 | if (length > 64) | 
|  | 380 | read_length= 64; | 
|  | 381 | else | 
|  | 382 | read_length = (__u8)length; | 
|  | 383 |  | 
|  | 384 | if (read_length > 1) { | 
|  | 385 | dbg ("%s - @ %x for %d", __FUNCTION__, | 
|  | 386 | start_address, read_length); | 
|  | 387 | } | 
|  | 388 | be_start_address = cpu_to_be16 (start_address); | 
|  | 389 | status = TIReadVendorRequestSync (dev, | 
|  | 390 | UMPC_MEMORY_READ,	// Request | 
|  | 391 | (__u16)address_type,	// wValue (Address type) | 
|  | 392 | (__force __u16)be_start_address,	// wIndex (Address to read) | 
|  | 393 | buffer,		// TransferBuffer | 
|  | 394 | read_length);	// TransferBufferLength | 
|  | 395 |  | 
|  | 396 | if (status) { | 
|  | 397 | dbg ("%s - ERROR %x", __FUNCTION__, status); | 
|  | 398 | return status; | 
|  | 399 | } | 
|  | 400 |  | 
|  | 401 | if (read_length > 1) { | 
|  | 402 | usb_serial_debug_data(debug, &dev->dev, __FUNCTION__, | 
|  | 403 | read_length, buffer); | 
|  | 404 | } | 
|  | 405 |  | 
|  | 406 | /* Update pointers/length */ | 
|  | 407 | start_address += read_length; | 
|  | 408 | buffer += read_length; | 
|  | 409 | length -= read_length; | 
|  | 410 | } | 
|  | 411 |  | 
|  | 412 | return status; | 
|  | 413 | } | 
|  | 414 |  | 
|  | 415 | static int TIReadRam (struct usb_device *dev, int start_address, int length, __u8 *buffer) | 
|  | 416 | { | 
|  | 417 | return TIReadDownloadMemory (dev, | 
|  | 418 | start_address, | 
|  | 419 | length, | 
|  | 420 | DTK_ADDR_SPACE_XDATA, | 
|  | 421 | buffer); | 
|  | 422 | } | 
|  | 423 |  | 
|  | 424 | /* Read edgeport memory to a given block */ | 
|  | 425 | static int TIReadBootMemory (struct edgeport_serial *serial, int start_address, int length, __u8 * buffer) | 
|  | 426 | { | 
|  | 427 | int status = 0; | 
|  | 428 | int i; | 
|  | 429 |  | 
|  | 430 | for (i=0; i< length; i++) { | 
|  | 431 | status = TIReadVendorRequestSync (serial->serial->dev, | 
|  | 432 | UMPC_MEMORY_READ,		// Request | 
|  | 433 | serial->TI_I2C_Type,		// wValue (Address type) | 
|  | 434 | (__u16)(start_address+i),	// wIndex | 
|  | 435 | &buffer[i],			// TransferBuffer | 
|  | 436 | 0x01);				// TransferBufferLength | 
|  | 437 | if (status) { | 
|  | 438 | dbg ("%s - ERROR %x", __FUNCTION__, status); | 
|  | 439 | return status; | 
|  | 440 | } | 
|  | 441 | } | 
|  | 442 |  | 
|  | 443 | dbg ("%s - start_address = %x, length = %d", __FUNCTION__, start_address, length); | 
|  | 444 | usb_serial_debug_data(debug, &serial->serial->dev->dev, __FUNCTION__, length, buffer); | 
|  | 445 |  | 
|  | 446 | serial->TiReadI2C = 1; | 
|  | 447 |  | 
|  | 448 | return status; | 
|  | 449 | } | 
|  | 450 |  | 
|  | 451 | /* Write given block to TI EPROM memory */ | 
|  | 452 | static int TIWriteBootMemory (struct edgeport_serial *serial, int start_address, int length, __u8 *buffer) | 
|  | 453 | { | 
|  | 454 | int status = 0; | 
|  | 455 | int i; | 
|  | 456 | __u8 temp; | 
|  | 457 |  | 
|  | 458 | /* Must do a read before write */ | 
|  | 459 | if (!serial->TiReadI2C) { | 
|  | 460 | status = TIReadBootMemory(serial, 0, 1, &temp); | 
|  | 461 | if (status) | 
|  | 462 | return status; | 
|  | 463 | } | 
|  | 464 |  | 
|  | 465 | for (i=0; i < length; ++i) { | 
|  | 466 | status = TISendVendorRequestSync (serial->serial->dev, | 
|  | 467 | UMPC_MEMORY_WRITE,		// Request | 
|  | 468 | buffer[i],			// wValue | 
|  | 469 | (__u16)(i+start_address),	// wIndex | 
|  | 470 | NULL,				// TransferBuffer | 
|  | 471 | 0);				// TransferBufferLength | 
|  | 472 | if (status) | 
|  | 473 | return status; | 
|  | 474 | } | 
|  | 475 |  | 
|  | 476 | dbg ("%s - start_sddr = %x, length = %d", __FUNCTION__, start_address, length); | 
|  | 477 | usb_serial_debug_data(debug, &serial->serial->dev->dev, __FUNCTION__, length, buffer); | 
|  | 478 |  | 
|  | 479 | return status; | 
|  | 480 | } | 
|  | 481 |  | 
|  | 482 |  | 
|  | 483 | /* Write edgeport I2C memory to TI chip	*/ | 
|  | 484 | static int TIWriteDownloadI2C (struct edgeport_serial *serial, int start_address, int length, __u8 address_type, __u8 *buffer) | 
|  | 485 | { | 
|  | 486 | int status = 0; | 
|  | 487 | int write_length; | 
|  | 488 | __be16 be_start_address; | 
|  | 489 |  | 
|  | 490 | /* We can only send a maximum of 1 aligned byte page at a time */ | 
|  | 491 |  | 
|  | 492 | /* calulate the number of bytes left in the first page */ | 
|  | 493 | write_length = EPROM_PAGE_SIZE - (start_address & (EPROM_PAGE_SIZE - 1)); | 
|  | 494 |  | 
|  | 495 | if (write_length > length) | 
|  | 496 | write_length = length; | 
|  | 497 |  | 
|  | 498 | dbg ("%s - BytesInFirstPage Addr = %x, length = %d", __FUNCTION__, start_address, write_length); | 
|  | 499 | usb_serial_debug_data(debug, &serial->serial->dev->dev, __FUNCTION__, write_length, buffer); | 
|  | 500 |  | 
|  | 501 | /* Write first page */ | 
|  | 502 | be_start_address = cpu_to_be16 (start_address); | 
|  | 503 | status = TISendVendorRequestSync (serial->serial->dev, | 
|  | 504 | UMPC_MEMORY_WRITE,	// Request | 
|  | 505 | (__u16)address_type,	// wValue | 
|  | 506 | (__force __u16)be_start_address,	// wIndex | 
|  | 507 | buffer,			// TransferBuffer | 
|  | 508 | write_length); | 
|  | 509 | if (status) { | 
|  | 510 | dbg ("%s - ERROR %d", __FUNCTION__, status); | 
|  | 511 | return status; | 
|  | 512 | } | 
|  | 513 |  | 
|  | 514 | length		-= write_length; | 
|  | 515 | start_address	+= write_length; | 
|  | 516 | buffer		+= write_length; | 
|  | 517 |  | 
|  | 518 | /* We should be aligned now -- can write max page size bytes at a time */ | 
|  | 519 | while (length) { | 
|  | 520 | if (length > EPROM_PAGE_SIZE) | 
|  | 521 | write_length = EPROM_PAGE_SIZE; | 
|  | 522 | else | 
|  | 523 | write_length = length; | 
|  | 524 |  | 
|  | 525 | dbg ("%s - Page Write Addr = %x, length = %d", __FUNCTION__, start_address, write_length); | 
|  | 526 | usb_serial_debug_data(debug, &serial->serial->dev->dev, __FUNCTION__, write_length, buffer); | 
|  | 527 |  | 
|  | 528 | /* Write next page */ | 
|  | 529 | be_start_address = cpu_to_be16 (start_address); | 
|  | 530 | status = TISendVendorRequestSync (serial->serial->dev, | 
|  | 531 | UMPC_MEMORY_WRITE,	// Request | 
|  | 532 | (__u16)address_type,	// wValue | 
|  | 533 | (__force __u16)be_start_address,	// wIndex | 
|  | 534 | buffer,	  		// TransferBuffer | 
|  | 535 | write_length);		// TransferBufferLength | 
|  | 536 | if (status) { | 
|  | 537 | dev_err (&serial->serial->dev->dev, "%s - ERROR %d\n", __FUNCTION__, status); | 
|  | 538 | return status; | 
|  | 539 | } | 
|  | 540 |  | 
|  | 541 | length		-= write_length; | 
|  | 542 | start_address	+= write_length; | 
|  | 543 | buffer		+= write_length; | 
|  | 544 | } | 
|  | 545 | return status; | 
|  | 546 | } | 
|  | 547 |  | 
|  | 548 | /* Examine the UMP DMA registers and LSR | 
|  | 549 | * | 
|  | 550 | * Check the MSBit of the X and Y DMA byte count registers. | 
|  | 551 | * A zero in this bit indicates that the TX DMA buffers are empty | 
|  | 552 | * then check the TX Empty bit in the UART. | 
|  | 553 | */ | 
|  | 554 | static int TIIsTxActive (struct edgeport_port *port) | 
|  | 555 | { | 
|  | 556 | int status; | 
|  | 557 | struct out_endpoint_desc_block *oedb; | 
|  | 558 | __u8 *lsr; | 
|  | 559 | int bytes_left = 0; | 
|  | 560 |  | 
|  | 561 | oedb = kmalloc (sizeof (* oedb), GFP_KERNEL); | 
|  | 562 | if (!oedb) { | 
|  | 563 | dev_err (&port->port->dev, "%s - out of memory\n", __FUNCTION__); | 
|  | 564 | return -ENOMEM; | 
|  | 565 | } | 
|  | 566 |  | 
|  | 567 | lsr = kmalloc (1, GFP_KERNEL);	/* Sigh, that's right, just one byte, | 
|  | 568 | as not all platforms can do DMA | 
|  | 569 | from stack */ | 
|  | 570 | if (!lsr) { | 
|  | 571 | kfree(oedb); | 
|  | 572 | return -ENOMEM; | 
|  | 573 | } | 
|  | 574 | /* Read the DMA Count Registers */ | 
|  | 575 | status = TIReadRam (port->port->serial->dev, | 
|  | 576 | port->dma_address, | 
|  | 577 | sizeof( *oedb), | 
|  | 578 | (void *)oedb); | 
|  | 579 |  | 
|  | 580 | if (status) | 
|  | 581 | goto exit_is_tx_active; | 
|  | 582 |  | 
|  | 583 | dbg ("%s - XByteCount    0x%X", __FUNCTION__, oedb->XByteCount); | 
|  | 584 |  | 
|  | 585 | /* and the LSR */ | 
|  | 586 | status = TIReadRam (port->port->serial->dev, | 
|  | 587 | port->uart_base + UMPMEM_OFFS_UART_LSR, | 
|  | 588 | 1, | 
|  | 589 | lsr); | 
|  | 590 |  | 
|  | 591 | if (status) | 
|  | 592 | goto exit_is_tx_active; | 
|  | 593 | dbg ("%s - LSR = 0x%X", __FUNCTION__, *lsr); | 
|  | 594 |  | 
|  | 595 | /* If either buffer has data or we are transmitting then return TRUE */ | 
|  | 596 | if ((oedb->XByteCount & 0x80 ) != 0 ) | 
|  | 597 | bytes_left += 64; | 
|  | 598 |  | 
|  | 599 | if ((*lsr & UMP_UART_LSR_TX_MASK ) == 0 ) | 
|  | 600 | bytes_left += 1; | 
|  | 601 |  | 
|  | 602 | /* We return Not Active if we get any kind of error */ | 
|  | 603 | exit_is_tx_active: | 
|  | 604 | dbg ("%s - return %d", __FUNCTION__, bytes_left ); | 
|  | 605 |  | 
|  | 606 | kfree(lsr); | 
|  | 607 | kfree(oedb); | 
|  | 608 | return bytes_left; | 
|  | 609 | } | 
|  | 610 |  | 
|  | 611 | static void TIChasePort(struct edgeport_port *port, unsigned long timeout, int flush) | 
|  | 612 | { | 
|  | 613 | int baud_rate; | 
|  | 614 | struct tty_struct *tty = port->port->tty; | 
|  | 615 | wait_queue_t wait; | 
|  | 616 | unsigned long flags; | 
|  | 617 |  | 
|  | 618 | if (!timeout) | 
|  | 619 | timeout = (HZ*EDGE_CLOSING_WAIT)/100; | 
|  | 620 |  | 
|  | 621 | /* wait for data to drain from the buffer */ | 
|  | 622 | spin_lock_irqsave(&port->ep_lock, flags); | 
|  | 623 | init_waitqueue_entry(&wait, current); | 
|  | 624 | add_wait_queue(&tty->write_wait, &wait); | 
|  | 625 | for (;;) { | 
|  | 626 | set_current_state(TASK_INTERRUPTIBLE); | 
|  | 627 | if (edge_buf_data_avail(port->ep_out_buf) == 0 | 
|  | 628 | || timeout == 0 || signal_pending(current) | 
|  | 629 | || !usb_get_intfdata(port->port->serial->interface))  /* disconnect */ | 
|  | 630 | break; | 
|  | 631 | spin_unlock_irqrestore(&port->ep_lock, flags); | 
|  | 632 | timeout = schedule_timeout(timeout); | 
|  | 633 | spin_lock_irqsave(&port->ep_lock, flags); | 
|  | 634 | } | 
|  | 635 | set_current_state(TASK_RUNNING); | 
|  | 636 | remove_wait_queue(&tty->write_wait, &wait); | 
|  | 637 | if (flush) | 
|  | 638 | edge_buf_clear(port->ep_out_buf); | 
|  | 639 | spin_unlock_irqrestore(&port->ep_lock, flags); | 
|  | 640 |  | 
|  | 641 | /* wait for data to drain from the device */ | 
|  | 642 | timeout += jiffies; | 
|  | 643 | while ((long)(jiffies - timeout) < 0 && !signal_pending(current) | 
|  | 644 | && usb_get_intfdata(port->port->serial->interface)) {  /* not disconnected */ | 
|  | 645 | if (!TIIsTxActive(port)) | 
|  | 646 | break; | 
|  | 647 | msleep(10); | 
|  | 648 | } | 
|  | 649 |  | 
|  | 650 | /* disconnected */ | 
|  | 651 | if (!usb_get_intfdata(port->port->serial->interface)) | 
|  | 652 | return; | 
|  | 653 |  | 
|  | 654 | /* wait one more character time, based on baud rate */ | 
|  | 655 | /* (TIIsTxActive doesn't seem to wait for the last byte) */ | 
|  | 656 | if ((baud_rate=port->baud_rate) == 0) | 
|  | 657 | baud_rate = 50; | 
|  | 658 | msleep(max(1,(10000+baud_rate-1)/baud_rate)); | 
|  | 659 | } | 
|  | 660 |  | 
|  | 661 | static int TIChooseConfiguration (struct usb_device *dev) | 
|  | 662 | { | 
|  | 663 | // There may be multiple configurations on this device, in which case | 
|  | 664 | // we would need to read and parse all of them to find out which one | 
|  | 665 | // we want. However, we just support one config at this point, | 
|  | 666 | // configuration # 1, which is Config Descriptor 0. | 
|  | 667 |  | 
|  | 668 | dbg ("%s - Number of Interfaces = %d", __FUNCTION__, dev->config->desc.bNumInterfaces); | 
|  | 669 | dbg ("%s - MAX Power            = %d", __FUNCTION__, dev->config->desc.bMaxPower*2); | 
|  | 670 |  | 
|  | 671 | if (dev->config->desc.bNumInterfaces != 1) { | 
|  | 672 | dev_err (&dev->dev, "%s - bNumInterfaces is not 1, ERROR!\n", __FUNCTION__); | 
|  | 673 | return -ENODEV; | 
|  | 674 | } | 
|  | 675 |  | 
|  | 676 | return 0; | 
|  | 677 | } | 
|  | 678 |  | 
|  | 679 | static int TIReadRom (struct edgeport_serial *serial, int start_address, int length, __u8 *buffer) | 
|  | 680 | { | 
|  | 681 | int status; | 
|  | 682 |  | 
|  | 683 | if (serial->product_info.TiMode == TI_MODE_DOWNLOAD) { | 
|  | 684 | status = TIReadDownloadMemory (serial->serial->dev, | 
|  | 685 | start_address, | 
|  | 686 | length, | 
|  | 687 | serial->TI_I2C_Type, | 
|  | 688 | buffer); | 
|  | 689 | } else { | 
|  | 690 | status = TIReadBootMemory (serial, | 
|  | 691 | start_address, | 
|  | 692 | length, | 
|  | 693 | buffer); | 
|  | 694 | } | 
|  | 695 |  | 
|  | 696 | return status; | 
|  | 697 | } | 
|  | 698 |  | 
|  | 699 | static int TIWriteRom (struct edgeport_serial *serial, int start_address, int length, __u8 *buffer) | 
|  | 700 | { | 
|  | 701 | if (serial->product_info.TiMode == TI_MODE_BOOT) | 
|  | 702 | return TIWriteBootMemory (serial, | 
|  | 703 | start_address, | 
|  | 704 | length, | 
|  | 705 | buffer); | 
|  | 706 |  | 
|  | 707 | if (serial->product_info.TiMode == TI_MODE_DOWNLOAD) | 
|  | 708 | return TIWriteDownloadI2C (serial, | 
|  | 709 | start_address, | 
|  | 710 | length, | 
|  | 711 | serial->TI_I2C_Type, | 
|  | 712 | buffer); | 
|  | 713 |  | 
|  | 714 | return -EINVAL; | 
|  | 715 | } | 
|  | 716 |  | 
|  | 717 |  | 
|  | 718 |  | 
|  | 719 | /* Read a descriptor header from I2C based on type */ | 
|  | 720 | static int TIGetDescriptorAddress (struct edgeport_serial *serial, int desc_type, struct ti_i2c_desc *rom_desc) | 
|  | 721 | { | 
|  | 722 | int start_address; | 
|  | 723 | int status; | 
|  | 724 |  | 
|  | 725 | /* Search for requested descriptor in I2C */ | 
|  | 726 | start_address = 2; | 
|  | 727 | do { | 
|  | 728 | status = TIReadRom (serial, | 
|  | 729 | start_address, | 
|  | 730 | sizeof(struct ti_i2c_desc), | 
|  | 731 | (__u8 *)rom_desc ); | 
|  | 732 | if (status) | 
|  | 733 | return 0; | 
|  | 734 |  | 
|  | 735 | if (rom_desc->Type == desc_type) | 
|  | 736 | return start_address; | 
|  | 737 |  | 
|  | 738 | start_address = start_address + sizeof(struct ti_i2c_desc) +  rom_desc->Size; | 
|  | 739 |  | 
|  | 740 | } while ((start_address < TI_MAX_I2C_SIZE) && rom_desc->Type); | 
|  | 741 |  | 
|  | 742 | return 0; | 
|  | 743 | } | 
|  | 744 |  | 
|  | 745 | /* Validate descriptor checksum */ | 
|  | 746 | static int ValidChecksum(struct ti_i2c_desc *rom_desc, __u8 *buffer) | 
|  | 747 | { | 
|  | 748 | __u16 i; | 
|  | 749 | __u8 cs = 0; | 
|  | 750 |  | 
|  | 751 | for (i=0; i < rom_desc->Size; i++) { | 
|  | 752 | cs = (__u8)(cs + buffer[i]); | 
|  | 753 | } | 
|  | 754 | if (cs != rom_desc->CheckSum) { | 
|  | 755 | dbg ("%s - Mismatch %x - %x", __FUNCTION__, rom_desc->CheckSum, cs); | 
|  | 756 | return -EINVAL; | 
|  | 757 | } | 
|  | 758 | return 0; | 
|  | 759 | } | 
|  | 760 |  | 
|  | 761 | /* Make sure that the I2C image is good */ | 
|  | 762 | static int TiValidateI2cImage (struct edgeport_serial *serial) | 
|  | 763 | { | 
|  | 764 | struct device *dev = &serial->serial->dev->dev; | 
|  | 765 | int status = 0; | 
|  | 766 | struct ti_i2c_desc *rom_desc; | 
|  | 767 | int start_address = 2; | 
|  | 768 | __u8 *buffer; | 
|  | 769 | __u16 ttype; | 
|  | 770 |  | 
|  | 771 | rom_desc = kmalloc (sizeof (*rom_desc), GFP_KERNEL); | 
|  | 772 | if (!rom_desc) { | 
|  | 773 | dev_err (dev, "%s - out of memory\n", __FUNCTION__); | 
|  | 774 | return -ENOMEM; | 
|  | 775 | } | 
|  | 776 | buffer = kmalloc (TI_MAX_I2C_SIZE, GFP_KERNEL); | 
|  | 777 | if (!buffer) { | 
|  | 778 | dev_err (dev, "%s - out of memory when allocating buffer\n", __FUNCTION__); | 
|  | 779 | kfree (rom_desc); | 
|  | 780 | return -ENOMEM; | 
|  | 781 | } | 
|  | 782 |  | 
|  | 783 | // Read the first byte (Signature0) must be 0x52 or 0x10 | 
|  | 784 | status = TIReadRom (serial, 0, 1, buffer); | 
|  | 785 | if (status) | 
|  | 786 | goto ExitTiValidateI2cImage; | 
|  | 787 |  | 
|  | 788 | if (*buffer != UMP5152 && *buffer != UMP3410) { | 
|  | 789 | dev_err (dev, "%s - invalid buffer signature\n", __FUNCTION__); | 
|  | 790 | status = -ENODEV; | 
|  | 791 | goto ExitTiValidateI2cImage; | 
|  | 792 | } | 
|  | 793 |  | 
|  | 794 | do { | 
|  | 795 | // Validate the I2C | 
|  | 796 | status = TIReadRom (serial, | 
|  | 797 | start_address, | 
|  | 798 | sizeof(struct ti_i2c_desc), | 
|  | 799 | (__u8 *)rom_desc); | 
|  | 800 | if (status) | 
|  | 801 | break; | 
|  | 802 |  | 
|  | 803 | if ((start_address + sizeof(struct ti_i2c_desc) + rom_desc->Size) > TI_MAX_I2C_SIZE) { | 
|  | 804 | status = -ENODEV; | 
|  | 805 | dbg ("%s - structure too big, erroring out.", __FUNCTION__); | 
|  | 806 | break; | 
|  | 807 | } | 
|  | 808 |  | 
|  | 809 | dbg ("%s Type = 0x%x", __FUNCTION__, rom_desc->Type); | 
|  | 810 |  | 
|  | 811 | // Skip type 2 record | 
|  | 812 | ttype = rom_desc->Type & 0x0f; | 
|  | 813 | if ( ttype != I2C_DESC_TYPE_FIRMWARE_BASIC | 
|  | 814 | && ttype != I2C_DESC_TYPE_FIRMWARE_AUTO ) { | 
|  | 815 | // Read the descriptor data | 
|  | 816 | status = TIReadRom(serial, | 
|  | 817 | start_address+sizeof(struct ti_i2c_desc), | 
|  | 818 | rom_desc->Size, | 
|  | 819 | buffer); | 
|  | 820 | if (status) | 
|  | 821 | break; | 
|  | 822 |  | 
|  | 823 | status = ValidChecksum(rom_desc, buffer); | 
|  | 824 | if (status) | 
|  | 825 | break; | 
|  | 826 | } | 
|  | 827 | start_address = start_address + sizeof(struct ti_i2c_desc) + rom_desc->Size; | 
|  | 828 |  | 
|  | 829 | } while ((rom_desc->Type != I2C_DESC_TYPE_ION) && (start_address < TI_MAX_I2C_SIZE)); | 
|  | 830 |  | 
|  | 831 | if ((rom_desc->Type != I2C_DESC_TYPE_ION) || (start_address > TI_MAX_I2C_SIZE)) | 
|  | 832 | status = -ENODEV; | 
|  | 833 |  | 
|  | 834 | ExitTiValidateI2cImage: | 
|  | 835 | kfree (buffer); | 
|  | 836 | kfree (rom_desc); | 
|  | 837 | return status; | 
|  | 838 | } | 
|  | 839 |  | 
|  | 840 | static int TIReadManufDescriptor (struct edgeport_serial *serial, __u8 *buffer) | 
|  | 841 | { | 
|  | 842 | int status; | 
|  | 843 | int start_address; | 
|  | 844 | struct ti_i2c_desc *rom_desc; | 
|  | 845 | struct edge_ti_manuf_descriptor *desc; | 
|  | 846 |  | 
|  | 847 | rom_desc = kmalloc (sizeof (*rom_desc), GFP_KERNEL); | 
|  | 848 | if (!rom_desc) { | 
|  | 849 | dev_err (&serial->serial->dev->dev, "%s - out of memory\n", __FUNCTION__); | 
|  | 850 | return -ENOMEM; | 
|  | 851 | } | 
|  | 852 | start_address = TIGetDescriptorAddress (serial, I2C_DESC_TYPE_ION, rom_desc); | 
|  | 853 |  | 
|  | 854 | if (!start_address) { | 
|  | 855 | dbg ("%s - Edge Descriptor not found in I2C", __FUNCTION__); | 
|  | 856 | status = -ENODEV; | 
|  | 857 | goto exit; | 
|  | 858 | } | 
|  | 859 |  | 
|  | 860 | // Read the descriptor data | 
|  | 861 | status = TIReadRom (serial, | 
|  | 862 | start_address+sizeof(struct ti_i2c_desc), | 
|  | 863 | rom_desc->Size, | 
|  | 864 | buffer); | 
|  | 865 | if (status) | 
|  | 866 | goto exit; | 
|  | 867 |  | 
|  | 868 | status = ValidChecksum(rom_desc, buffer); | 
|  | 869 |  | 
|  | 870 | desc = (struct edge_ti_manuf_descriptor *)buffer; | 
|  | 871 | dbg ( "%s - IonConfig      0x%x", __FUNCTION__, desc->IonConfig 	); | 
|  | 872 | dbg ( "%s - Version          %d", __FUNCTION__, desc->Version	  	); | 
|  | 873 | dbg ( "%s - Cpu/Board      0x%x", __FUNCTION__, desc->CpuRev_BoardRev	); | 
|  | 874 | dbg ( "%s - NumPorts         %d", __FUNCTION__, desc->NumPorts  	); | 
|  | 875 | dbg ( "%s - NumVirtualPorts  %d", __FUNCTION__, desc->NumVirtualPorts	); | 
|  | 876 | dbg ( "%s - TotalPorts       %d", __FUNCTION__, desc->TotalPorts  	); | 
|  | 877 |  | 
|  | 878 | exit: | 
|  | 879 | kfree (rom_desc); | 
|  | 880 | return status; | 
|  | 881 | } | 
|  | 882 |  | 
|  | 883 | /* Build firmware header used for firmware update */ | 
|  | 884 | static int BuildI2CFirmwareHeader (__u8 *header, struct device *dev) | 
|  | 885 | { | 
|  | 886 | __u8 *buffer; | 
|  | 887 | int buffer_size; | 
|  | 888 | int i; | 
|  | 889 | __u8 cs = 0; | 
|  | 890 | struct ti_i2c_desc *i2c_header; | 
|  | 891 | struct ti_i2c_image_header *img_header; | 
|  | 892 | struct ti_i2c_firmware_rec *firmware_rec; | 
|  | 893 |  | 
|  | 894 | // In order to update the I2C firmware we must change the type 2 record to type 0xF2. | 
|  | 895 | // This will force the UMP to come up in Boot Mode.  Then while in boot mode, the driver | 
|  | 896 | // will download the latest firmware (padded to 15.5k) into the UMP ram. | 
|  | 897 | // And finally when the device comes back up in download mode the driver will cause | 
|  | 898 | // the new firmware to be copied from the UMP Ram to I2C and the firmware will update | 
|  | 899 | // the record type from 0xf2 to 0x02. | 
|  | 900 |  | 
|  | 901 | // Allocate a 15.5k buffer + 2 bytes for version number (Firmware Record) | 
|  | 902 | buffer_size = (((1024 * 16) - 512 )+ sizeof(struct ti_i2c_firmware_rec)); | 
|  | 903 |  | 
|  | 904 | buffer = kmalloc (buffer_size, GFP_KERNEL); | 
|  | 905 | if (!buffer) { | 
|  | 906 | dev_err (dev, "%s - out of memory\n", __FUNCTION__); | 
|  | 907 | return -ENOMEM; | 
|  | 908 | } | 
|  | 909 |  | 
|  | 910 | // Set entire image of 0xffs | 
|  | 911 | memset (buffer, 0xff, buffer_size); | 
|  | 912 |  | 
|  | 913 | // Copy version number into firmware record | 
|  | 914 | firmware_rec = (struct ti_i2c_firmware_rec *)buffer; | 
|  | 915 |  | 
|  | 916 | firmware_rec->Ver_Major	= OperationalCodeImageVersion.MajorVersion; | 
|  | 917 | firmware_rec->Ver_Minor	= OperationalCodeImageVersion.MinorVersion; | 
|  | 918 |  | 
|  | 919 | // Pointer to fw_down memory image | 
|  | 920 | img_header = (struct ti_i2c_image_header *)&PagableOperationalCodeImage[0]; | 
|  | 921 |  | 
|  | 922 | memcpy (buffer + sizeof(struct ti_i2c_firmware_rec), | 
|  | 923 | &PagableOperationalCodeImage[sizeof(struct ti_i2c_image_header)], | 
|  | 924 | le16_to_cpu(img_header->Length)); | 
|  | 925 |  | 
|  | 926 | for (i=0; i < buffer_size; i++) { | 
|  | 927 | cs = (__u8)(cs + buffer[i]); | 
|  | 928 | } | 
|  | 929 |  | 
|  | 930 | kfree (buffer); | 
|  | 931 |  | 
|  | 932 | // Build new header | 
|  | 933 | i2c_header =  (struct ti_i2c_desc *)header; | 
|  | 934 | firmware_rec =  (struct ti_i2c_firmware_rec*)i2c_header->Data; | 
|  | 935 |  | 
|  | 936 | i2c_header->Type	= I2C_DESC_TYPE_FIRMWARE_BLANK; | 
|  | 937 | i2c_header->Size	= (__u16)buffer_size; | 
|  | 938 | i2c_header->CheckSum	= cs; | 
|  | 939 | firmware_rec->Ver_Major	= OperationalCodeImageVersion.MajorVersion; | 
|  | 940 | firmware_rec->Ver_Minor	= OperationalCodeImageVersion.MinorVersion; | 
|  | 941 |  | 
|  | 942 | return 0; | 
|  | 943 | } | 
|  | 944 |  | 
|  | 945 | /* Try to figure out what type of I2c we have */ | 
|  | 946 | static int TIGetI2cTypeInBootMode (struct edgeport_serial *serial) | 
|  | 947 | { | 
|  | 948 | int status; | 
|  | 949 | __u8 data; | 
|  | 950 |  | 
|  | 951 | // Try to read type 2 | 
|  | 952 | status = TIReadVendorRequestSync (serial->serial->dev, | 
|  | 953 | UMPC_MEMORY_READ,		// Request | 
|  | 954 | DTK_ADDR_SPACE_I2C_TYPE_II,	// wValue (Address type) | 
|  | 955 | 0,		 		// wIndex | 
|  | 956 | &data,				// TransferBuffer | 
|  | 957 | 0x01);				// TransferBufferLength | 
|  | 958 | if (status) | 
|  | 959 | dbg ("%s - read 2 status error = %d", __FUNCTION__, status); | 
|  | 960 | else | 
|  | 961 | dbg ("%s - read 2 data = 0x%x", __FUNCTION__, data); | 
|  | 962 | if ((!status) && (data == UMP5152 || data == UMP3410)) { | 
|  | 963 | dbg ("%s - ROM_TYPE_II", __FUNCTION__); | 
|  | 964 | serial->TI_I2C_Type = DTK_ADDR_SPACE_I2C_TYPE_II; | 
|  | 965 | return 0; | 
|  | 966 | } | 
|  | 967 |  | 
|  | 968 | // Try to read type 3 | 
|  | 969 | status = TIReadVendorRequestSync (serial->serial->dev, | 
|  | 970 | UMPC_MEMORY_READ,		// Request | 
|  | 971 | DTK_ADDR_SPACE_I2C_TYPE_III,	// wValue (Address type) | 
|  | 972 | 0,				// wIndex | 
|  | 973 | &data,				// TransferBuffer | 
|  | 974 | 0x01);				// TransferBufferLength | 
|  | 975 | if (status) | 
|  | 976 | dbg ("%s - read 3 status error = %d", __FUNCTION__, status); | 
|  | 977 | else | 
|  | 978 | dbg ("%s - read 2 data = 0x%x", __FUNCTION__, data); | 
|  | 979 | if ((!status) && (data == UMP5152 || data == UMP3410)) { | 
|  | 980 | dbg ("%s - ROM_TYPE_III", __FUNCTION__); | 
|  | 981 | serial->TI_I2C_Type = DTK_ADDR_SPACE_I2C_TYPE_III; | 
|  | 982 | return 0; | 
|  | 983 | } | 
|  | 984 |  | 
|  | 985 | dbg ("%s - Unknown", __FUNCTION__); | 
|  | 986 | serial->TI_I2C_Type = DTK_ADDR_SPACE_I2C_TYPE_II; | 
|  | 987 | return -ENODEV; | 
|  | 988 | } | 
|  | 989 |  | 
|  | 990 | static int TISendBulkTransferSync (struct usb_serial *serial, void *buffer, int length, int *num_sent) | 
|  | 991 | { | 
|  | 992 | int status; | 
|  | 993 |  | 
|  | 994 | status = usb_bulk_msg (serial->dev, | 
|  | 995 | usb_sndbulkpipe(serial->dev, | 
|  | 996 | serial->port[0]->bulk_out_endpointAddress), | 
|  | 997 | buffer, | 
|  | 998 | length, | 
|  | 999 | num_sent, | 
|  | 1000 | 1000); | 
|  | 1001 | return status; | 
|  | 1002 | } | 
|  | 1003 |  | 
|  | 1004 | /* Download given firmware image to the device (IN BOOT MODE) */ | 
|  | 1005 | static int TIDownloadCodeImage (struct edgeport_serial *serial, __u8 *image, int image_length) | 
|  | 1006 | { | 
|  | 1007 | int status = 0; | 
|  | 1008 | int pos; | 
|  | 1009 | int transfer; | 
|  | 1010 | int done; | 
|  | 1011 |  | 
|  | 1012 | // Transfer firmware image | 
|  | 1013 | for (pos = 0; pos < image_length; ) { | 
|  | 1014 | // Read the next buffer from file | 
|  | 1015 | transfer = image_length - pos; | 
|  | 1016 | if (transfer > EDGE_FW_BULK_MAX_PACKET_SIZE) | 
|  | 1017 | transfer = EDGE_FW_BULK_MAX_PACKET_SIZE; | 
|  | 1018 |  | 
|  | 1019 | // Transfer data | 
|  | 1020 | status = TISendBulkTransferSync (serial->serial, &image[pos], transfer, &done); | 
|  | 1021 | if (status) | 
|  | 1022 | break; | 
|  | 1023 | // Advance buffer pointer | 
|  | 1024 | pos += done; | 
|  | 1025 | } | 
|  | 1026 |  | 
|  | 1027 | return status; | 
|  | 1028 | } | 
|  | 1029 |  | 
|  | 1030 | // FIXME!!! | 
|  | 1031 | static int TIConfigureBootDevice (struct usb_device *dev) | 
|  | 1032 | { | 
|  | 1033 | return 0; | 
|  | 1034 | } | 
|  | 1035 |  | 
|  | 1036 | /** | 
|  | 1037 | * DownloadTIFirmware - Download run-time operating firmware to the TI5052 | 
|  | 1038 | * | 
|  | 1039 | * This routine downloads the main operating code into the TI5052, using the | 
|  | 1040 | * boot code already burned into E2PROM or ROM. | 
|  | 1041 | */ | 
|  | 1042 | static int TIDownloadFirmware (struct edgeport_serial *serial) | 
|  | 1043 | { | 
|  | 1044 | struct device *dev = &serial->serial->dev->dev; | 
|  | 1045 | int status = 0; | 
|  | 1046 | int start_address; | 
|  | 1047 | struct edge_ti_manuf_descriptor *ti_manuf_desc; | 
|  | 1048 | struct usb_interface_descriptor *interface; | 
|  | 1049 | int download_cur_ver; | 
|  | 1050 | int download_new_ver; | 
|  | 1051 |  | 
|  | 1052 | /* This routine is entered by both the BOOT mode and the Download mode | 
|  | 1053 | * We can determine which code is running by the reading the config | 
|  | 1054 | * descriptor and if we have only one bulk pipe it is in boot mode | 
|  | 1055 | */ | 
|  | 1056 | serial->product_info.hardware_type = HARDWARE_TYPE_TIUMP; | 
|  | 1057 |  | 
|  | 1058 | /* Default to type 2 i2c */ | 
|  | 1059 | serial->TI_I2C_Type = DTK_ADDR_SPACE_I2C_TYPE_II; | 
|  | 1060 |  | 
|  | 1061 | status = TIChooseConfiguration (serial->serial->dev); | 
|  | 1062 | if (status) | 
|  | 1063 | return status; | 
|  | 1064 |  | 
|  | 1065 | interface = &serial->serial->interface->cur_altsetting->desc; | 
|  | 1066 | if (!interface) { | 
|  | 1067 | dev_err (dev, "%s - no interface set, error!\n", __FUNCTION__); | 
|  | 1068 | return -ENODEV; | 
|  | 1069 | } | 
|  | 1070 |  | 
|  | 1071 | // Setup initial mode -- the default mode 0 is TI_MODE_CONFIGURING | 
|  | 1072 | // if we have more than one endpoint we are definitely in download mode | 
|  | 1073 | if (interface->bNumEndpoints > 1) | 
|  | 1074 | serial->product_info.TiMode = TI_MODE_DOWNLOAD; | 
|  | 1075 | else | 
|  | 1076 | // Otherwise we will remain in configuring mode | 
|  | 1077 | serial->product_info.TiMode = TI_MODE_CONFIGURING; | 
|  | 1078 |  | 
|  | 1079 | // Save Download Version Number | 
|  | 1080 | OperationalCodeImageVersion.MajorVersion = PagableOperationalCodeImageVersion.MajorVersion; | 
|  | 1081 | OperationalCodeImageVersion.MinorVersion = PagableOperationalCodeImageVersion.MinorVersion; | 
|  | 1082 | OperationalCodeImageVersion.BuildNumber	 = PagableOperationalCodeImageVersion.BuildNumber; | 
|  | 1083 |  | 
|  | 1084 | /********************************************************************/ | 
|  | 1085 | /* Download Mode */ | 
|  | 1086 | /********************************************************************/ | 
|  | 1087 | if (serial->product_info.TiMode == TI_MODE_DOWNLOAD) { | 
|  | 1088 | struct ti_i2c_desc *rom_desc; | 
|  | 1089 |  | 
|  | 1090 | dbg ("%s - <<<<<<<<<<<<<<<RUNNING IN DOWNLOAD MODE>>>>>>>>>>", __FUNCTION__); | 
|  | 1091 |  | 
|  | 1092 | status = TiValidateI2cImage (serial); | 
|  | 1093 | if (status) { | 
|  | 1094 | dbg ("%s - <<<<<<<<<<<<<<<DOWNLOAD MODE -- BAD I2C >>>>>>>>>>", | 
|  | 1095 | __FUNCTION__); | 
|  | 1096 | return status; | 
|  | 1097 | } | 
|  | 1098 |  | 
|  | 1099 | /* Validate Hardware version number | 
|  | 1100 | * Read Manufacturing Descriptor from TI Based Edgeport | 
|  | 1101 | */ | 
|  | 1102 | ti_manuf_desc = kmalloc (sizeof (*ti_manuf_desc), GFP_KERNEL); | 
|  | 1103 | if (!ti_manuf_desc) { | 
|  | 1104 | dev_err (dev, "%s - out of memory.\n", __FUNCTION__); | 
|  | 1105 | return -ENOMEM; | 
|  | 1106 | } | 
|  | 1107 | status = TIReadManufDescriptor (serial, (__u8 *)ti_manuf_desc); | 
|  | 1108 | if (status) { | 
|  | 1109 | kfree (ti_manuf_desc); | 
|  | 1110 | return status; | 
|  | 1111 | } | 
|  | 1112 |  | 
|  | 1113 | // Check version number of ION descriptor | 
|  | 1114 | if (!ignore_cpu_rev && TI_GET_CPU_REVISION(ti_manuf_desc->CpuRev_BoardRev) < 2) { | 
|  | 1115 | dbg ( "%s - Wrong CPU Rev %d (Must be 2)", __FUNCTION__, | 
|  | 1116 | TI_GET_CPU_REVISION(ti_manuf_desc->CpuRev_BoardRev)); | 
|  | 1117 | kfree (ti_manuf_desc); | 
|  | 1118 | return -EINVAL; | 
|  | 1119 | } | 
|  | 1120 |  | 
|  | 1121 | rom_desc = kmalloc (sizeof (*rom_desc), GFP_KERNEL); | 
|  | 1122 | if (!rom_desc) { | 
|  | 1123 | dev_err (dev, "%s - out of memory.\n", __FUNCTION__); | 
|  | 1124 | kfree (ti_manuf_desc); | 
|  | 1125 | return -ENOMEM; | 
|  | 1126 | } | 
|  | 1127 |  | 
|  | 1128 | // Search for type 2 record (firmware record) | 
|  | 1129 | if ((start_address = TIGetDescriptorAddress (serial, I2C_DESC_TYPE_FIRMWARE_BASIC, rom_desc)) != 0) { | 
|  | 1130 | struct ti_i2c_firmware_rec *firmware_version; | 
|  | 1131 | __u8 record; | 
|  | 1132 |  | 
|  | 1133 | dbg ("%s - Found Type FIRMWARE (Type 2) record", __FUNCTION__); | 
|  | 1134 |  | 
|  | 1135 | firmware_version = kmalloc (sizeof (*firmware_version), GFP_KERNEL); | 
|  | 1136 | if (!firmware_version) { | 
|  | 1137 | dev_err (dev, "%s - out of memory.\n", __FUNCTION__); | 
|  | 1138 | kfree (rom_desc); | 
|  | 1139 | kfree (ti_manuf_desc); | 
|  | 1140 | return -ENOMEM; | 
|  | 1141 | } | 
|  | 1142 |  | 
|  | 1143 | // Validate version number | 
|  | 1144 | // Read the descriptor data | 
|  | 1145 | status = TIReadRom (serial, | 
|  | 1146 | start_address+sizeof(struct ti_i2c_desc), | 
|  | 1147 | sizeof(struct ti_i2c_firmware_rec), | 
|  | 1148 | (__u8 *)firmware_version); | 
|  | 1149 | if (status) { | 
|  | 1150 | kfree (firmware_version); | 
|  | 1151 | kfree (rom_desc); | 
|  | 1152 | kfree (ti_manuf_desc); | 
|  | 1153 | return status; | 
|  | 1154 | } | 
|  | 1155 |  | 
|  | 1156 | // Check version number of download with current version in I2c | 
|  | 1157 | download_cur_ver = (firmware_version->Ver_Major << 8) + | 
|  | 1158 | (firmware_version->Ver_Minor); | 
|  | 1159 | download_new_ver = (OperationalCodeImageVersion.MajorVersion << 8) + | 
|  | 1160 | (OperationalCodeImageVersion.MinorVersion); | 
|  | 1161 |  | 
|  | 1162 | dbg ("%s - >>>Firmware Versions Device %d.%d  Driver %d.%d", | 
|  | 1163 | __FUNCTION__, | 
|  | 1164 | firmware_version->Ver_Major, | 
|  | 1165 | firmware_version->Ver_Minor, | 
|  | 1166 | OperationalCodeImageVersion.MajorVersion, | 
|  | 1167 | OperationalCodeImageVersion.MinorVersion); | 
|  | 1168 |  | 
|  | 1169 | // Check if we have an old version in the I2C and update if necessary | 
|  | 1170 | if (download_cur_ver != download_new_ver) { | 
|  | 1171 | dbg ("%s - Update I2C Download from %d.%d to %d.%d", | 
|  | 1172 | __FUNCTION__, | 
|  | 1173 | firmware_version->Ver_Major, | 
|  | 1174 | firmware_version->Ver_Minor, | 
|  | 1175 | OperationalCodeImageVersion.MajorVersion, | 
|  | 1176 | OperationalCodeImageVersion.MinorVersion); | 
|  | 1177 |  | 
|  | 1178 | // In order to update the I2C firmware we must change the type 2 record to type 0xF2. | 
|  | 1179 | // This will force the UMP to come up in Boot Mode.  Then while in boot mode, the driver | 
|  | 1180 | // will download the latest firmware (padded to 15.5k) into the UMP ram. | 
|  | 1181 | // And finally when the device comes back up in download mode the driver will cause | 
|  | 1182 | // the new firmware to be copied from the UMP Ram to I2C and the firmware will update | 
|  | 1183 | // the record type from 0xf2 to 0x02. | 
|  | 1184 |  | 
|  | 1185 | record = I2C_DESC_TYPE_FIRMWARE_BLANK; | 
|  | 1186 |  | 
|  | 1187 | // Change the I2C Firmware record type to 0xf2 to trigger an update | 
|  | 1188 | status = TIWriteRom (serial, | 
|  | 1189 | start_address, | 
|  | 1190 | sizeof(record), | 
|  | 1191 | &record); | 
|  | 1192 | if (status) { | 
|  | 1193 | kfree (firmware_version); | 
|  | 1194 | kfree (rom_desc); | 
|  | 1195 | kfree (ti_manuf_desc); | 
|  | 1196 | return status; | 
|  | 1197 | } | 
|  | 1198 |  | 
|  | 1199 | // verify the write -- must do this in order for write to | 
|  | 1200 | // complete before we do the hardware reset | 
|  | 1201 | status = TIReadRom (serial, | 
|  | 1202 | start_address, | 
|  | 1203 | sizeof(record), | 
|  | 1204 | &record); | 
|  | 1205 |  | 
|  | 1206 | if (status) { | 
|  | 1207 | kfree (firmware_version); | 
|  | 1208 | kfree (rom_desc); | 
|  | 1209 | kfree (ti_manuf_desc); | 
|  | 1210 | return status; | 
|  | 1211 | } | 
|  | 1212 |  | 
|  | 1213 | if (record != I2C_DESC_TYPE_FIRMWARE_BLANK) { | 
|  | 1214 | dev_err (dev, "%s - error resetting device\n", __FUNCTION__); | 
|  | 1215 | kfree (firmware_version); | 
|  | 1216 | kfree (rom_desc); | 
|  | 1217 | kfree (ti_manuf_desc); | 
|  | 1218 | return -ENODEV; | 
|  | 1219 | } | 
|  | 1220 |  | 
|  | 1221 | dbg ("%s - HARDWARE RESET", __FUNCTION__); | 
|  | 1222 |  | 
|  | 1223 | // Reset UMP -- Back to BOOT MODE | 
|  | 1224 | status = TISendVendorRequestSync (serial->serial->dev, | 
|  | 1225 | UMPC_HARDWARE_RESET,	// Request | 
|  | 1226 | 0,			// wValue | 
|  | 1227 | 0,			// wIndex | 
|  | 1228 | NULL,			// TransferBuffer | 
|  | 1229 | 0);			// TransferBufferLength | 
|  | 1230 |  | 
|  | 1231 | dbg ( "%s - HARDWARE RESET return %d", __FUNCTION__, status); | 
|  | 1232 |  | 
|  | 1233 | /* return an error on purpose. */ | 
|  | 1234 | kfree (firmware_version); | 
|  | 1235 | kfree (rom_desc); | 
|  | 1236 | kfree (ti_manuf_desc); | 
|  | 1237 | return -ENODEV; | 
|  | 1238 | } | 
|  | 1239 | kfree (firmware_version); | 
|  | 1240 | } | 
|  | 1241 | // Search for type 0xF2 record (firmware blank record) | 
|  | 1242 | else if ((start_address = TIGetDescriptorAddress (serial, I2C_DESC_TYPE_FIRMWARE_BLANK, rom_desc)) != 0) { | 
|  | 1243 | #define HEADER_SIZE	(sizeof(struct ti_i2c_desc) + sizeof(struct ti_i2c_firmware_rec)) | 
|  | 1244 | __u8 *header; | 
|  | 1245 | __u8 *vheader; | 
|  | 1246 |  | 
|  | 1247 | header  = kmalloc (HEADER_SIZE, GFP_KERNEL); | 
|  | 1248 | if (!header) { | 
|  | 1249 | dev_err (dev, "%s - out of memory.\n", __FUNCTION__); | 
|  | 1250 | kfree (rom_desc); | 
|  | 1251 | kfree (ti_manuf_desc); | 
|  | 1252 | return -ENOMEM; | 
|  | 1253 | } | 
|  | 1254 |  | 
|  | 1255 | vheader = kmalloc (HEADER_SIZE, GFP_KERNEL); | 
|  | 1256 | if (!vheader) { | 
|  | 1257 | dev_err (dev, "%s - out of memory.\n", __FUNCTION__); | 
|  | 1258 | kfree (header); | 
|  | 1259 | kfree (rom_desc); | 
|  | 1260 | kfree (ti_manuf_desc); | 
|  | 1261 | return -ENOMEM; | 
|  | 1262 | } | 
|  | 1263 |  | 
|  | 1264 | dbg ("%s - Found Type BLANK FIRMWARE (Type F2) record", __FUNCTION__); | 
|  | 1265 |  | 
|  | 1266 | // In order to update the I2C firmware we must change the type 2 record to type 0xF2. | 
|  | 1267 | // This will force the UMP to come up in Boot Mode.  Then while in boot mode, the driver | 
|  | 1268 | // will download the latest firmware (padded to 15.5k) into the UMP ram. | 
|  | 1269 | // And finally when the device comes back up in download mode the driver will cause | 
|  | 1270 | // the new firmware to be copied from the UMP Ram to I2C and the firmware will update | 
|  | 1271 | // the record type from 0xf2 to 0x02. | 
|  | 1272 | status = BuildI2CFirmwareHeader(header, dev); | 
|  | 1273 | if (status) { | 
|  | 1274 | kfree (vheader); | 
|  | 1275 | kfree (header); | 
|  | 1276 | kfree (rom_desc); | 
|  | 1277 | kfree (ti_manuf_desc); | 
|  | 1278 | return status; | 
|  | 1279 | } | 
|  | 1280 |  | 
|  | 1281 | // Update I2C with type 0xf2 record with correct size and checksum | 
|  | 1282 | status = TIWriteRom (serial, | 
|  | 1283 | start_address, | 
|  | 1284 | HEADER_SIZE, | 
|  | 1285 | header); | 
|  | 1286 | if (status) { | 
|  | 1287 | kfree (vheader); | 
|  | 1288 | kfree (header); | 
|  | 1289 | kfree (rom_desc); | 
|  | 1290 | kfree (ti_manuf_desc); | 
|  | 1291 | return status; | 
|  | 1292 | } | 
|  | 1293 |  | 
|  | 1294 | // verify the write -- must do this in order for write to | 
|  | 1295 | // complete before we do the hardware reset | 
|  | 1296 | status = TIReadRom (serial, | 
|  | 1297 | start_address, | 
|  | 1298 | HEADER_SIZE, | 
|  | 1299 | vheader); | 
|  | 1300 |  | 
|  | 1301 | if (status) { | 
|  | 1302 | dbg ("%s - can't read header back", __FUNCTION__); | 
|  | 1303 | kfree (vheader); | 
|  | 1304 | kfree (header); | 
|  | 1305 | kfree (rom_desc); | 
|  | 1306 | kfree (ti_manuf_desc); | 
|  | 1307 | return status; | 
|  | 1308 | } | 
|  | 1309 | if (memcmp(vheader, header, HEADER_SIZE)) { | 
|  | 1310 | dbg ("%s - write download record failed", __FUNCTION__); | 
|  | 1311 | kfree (vheader); | 
|  | 1312 | kfree (header); | 
|  | 1313 | kfree (rom_desc); | 
|  | 1314 | kfree (ti_manuf_desc); | 
|  | 1315 | return status; | 
|  | 1316 | } | 
|  | 1317 |  | 
|  | 1318 | kfree (vheader); | 
|  | 1319 | kfree (header); | 
|  | 1320 |  | 
|  | 1321 | dbg ("%s - Start firmware update", __FUNCTION__); | 
|  | 1322 |  | 
|  | 1323 | // Tell firmware to copy download image into I2C | 
|  | 1324 | status = TISendVendorRequestSync (serial->serial->dev, | 
|  | 1325 | UMPC_COPY_DNLD_TO_I2C,	// Request | 
|  | 1326 | 0,			// wValue | 
|  | 1327 | 0,			// wIndex | 
|  | 1328 | NULL,			// TransferBuffer | 
|  | 1329 | 0);			// TransferBufferLength | 
|  | 1330 |  | 
|  | 1331 | dbg ("%s - Update complete 0x%x", __FUNCTION__, status); | 
|  | 1332 | if (status) { | 
|  | 1333 | dev_err (dev, "%s - UMPC_COPY_DNLD_TO_I2C failed\n", __FUNCTION__); | 
|  | 1334 | kfree (rom_desc); | 
|  | 1335 | kfree (ti_manuf_desc); | 
|  | 1336 | return status; | 
|  | 1337 | } | 
|  | 1338 | } | 
|  | 1339 |  | 
|  | 1340 | // The device is running the download code | 
|  | 1341 | kfree (rom_desc); | 
|  | 1342 | kfree (ti_manuf_desc); | 
|  | 1343 | return 0; | 
|  | 1344 | } | 
|  | 1345 |  | 
|  | 1346 | /********************************************************************/ | 
|  | 1347 | /* Boot Mode */ | 
|  | 1348 | /********************************************************************/ | 
|  | 1349 | dbg ("%s - <<<<<<<<<<<<<<<RUNNING IN BOOT MODE>>>>>>>>>>>>>>>", | 
|  | 1350 | __FUNCTION__); | 
|  | 1351 |  | 
|  | 1352 | // Configure the TI device so we can use the BULK pipes for download | 
|  | 1353 | status = TIConfigureBootDevice (serial->serial->dev); | 
|  | 1354 | if (status) | 
|  | 1355 | return status; | 
|  | 1356 |  | 
|  | 1357 | if (le16_to_cpu(serial->serial->dev->descriptor.idVendor) != USB_VENDOR_ID_ION) { | 
|  | 1358 | dbg ("%s - VID = 0x%x", __FUNCTION__, | 
|  | 1359 | le16_to_cpu(serial->serial->dev->descriptor.idVendor)); | 
|  | 1360 | serial->TI_I2C_Type = DTK_ADDR_SPACE_I2C_TYPE_II; | 
|  | 1361 | goto StayInBootMode; | 
|  | 1362 | } | 
|  | 1363 |  | 
|  | 1364 | // We have an ION device (I2c Must be programmed) | 
|  | 1365 | // Determine I2C image type | 
|  | 1366 | if (TIGetI2cTypeInBootMode(serial)) { | 
|  | 1367 | goto StayInBootMode; | 
|  | 1368 | } | 
|  | 1369 |  | 
|  | 1370 | // Registry variable set? | 
|  | 1371 | if (TIStayInBootMode) { | 
|  | 1372 | dbg ("%s - TIStayInBootMode", __FUNCTION__); | 
|  | 1373 | goto StayInBootMode; | 
|  | 1374 | } | 
|  | 1375 |  | 
|  | 1376 | // Check for ION Vendor ID and that the I2C is valid | 
|  | 1377 | if (!TiValidateI2cImage(serial)) { | 
|  | 1378 | struct ti_i2c_image_header *header; | 
|  | 1379 | int i; | 
|  | 1380 | __u8 cs = 0; | 
|  | 1381 | __u8 *buffer; | 
|  | 1382 | int buffer_size; | 
|  | 1383 |  | 
|  | 1384 | /* Validate Hardware version number | 
|  | 1385 | * Read Manufacturing Descriptor from TI Based Edgeport | 
|  | 1386 | */ | 
|  | 1387 | ti_manuf_desc = kmalloc (sizeof (*ti_manuf_desc), GFP_KERNEL); | 
|  | 1388 | if (!ti_manuf_desc) { | 
|  | 1389 | dev_err (dev, "%s - out of memory.\n", __FUNCTION__); | 
|  | 1390 | return -ENOMEM; | 
|  | 1391 | } | 
|  | 1392 | status = TIReadManufDescriptor (serial, (__u8 *)ti_manuf_desc); | 
|  | 1393 | if (status) { | 
|  | 1394 | kfree (ti_manuf_desc); | 
|  | 1395 | goto StayInBootMode; | 
|  | 1396 | } | 
|  | 1397 |  | 
|  | 1398 | // Check for version 2 | 
|  | 1399 | if (!ignore_cpu_rev && TI_GET_CPU_REVISION(ti_manuf_desc->CpuRev_BoardRev) < 2) { | 
|  | 1400 | dbg ("%s - Wrong CPU Rev %d (Must be 2)", __FUNCTION__, | 
|  | 1401 | TI_GET_CPU_REVISION(ti_manuf_desc->CpuRev_BoardRev)); | 
|  | 1402 | kfree (ti_manuf_desc); | 
|  | 1403 | goto StayInBootMode; | 
|  | 1404 | } | 
|  | 1405 |  | 
|  | 1406 | kfree (ti_manuf_desc); | 
|  | 1407 |  | 
|  | 1408 | // In order to update the I2C firmware we must change the type 2 record to type 0xF2. | 
|  | 1409 | // This will force the UMP to come up in Boot Mode.  Then while in boot mode, the driver | 
|  | 1410 | // will download the latest firmware (padded to 15.5k) into the UMP ram. | 
|  | 1411 | // And finally when the device comes back up in download mode the driver will cause | 
|  | 1412 | // the new firmware to be copied from the UMP Ram to I2C and the firmware will update | 
|  | 1413 | // the record type from 0xf2 to 0x02. | 
|  | 1414 |  | 
|  | 1415 | /* | 
|  | 1416 | * Do we really have to copy the whole firmware image, | 
|  | 1417 | * or could we do this in place! | 
|  | 1418 | */ | 
|  | 1419 |  | 
|  | 1420 | // Allocate a 15.5k buffer + 3 byte header | 
|  | 1421 | buffer_size = (((1024 * 16) - 512) + sizeof(struct ti_i2c_image_header)); | 
|  | 1422 | buffer = kmalloc (buffer_size, GFP_KERNEL); | 
|  | 1423 | if (!buffer) { | 
|  | 1424 | dev_err (dev, "%s - out of memory\n", __FUNCTION__); | 
|  | 1425 | return -ENOMEM; | 
|  | 1426 | } | 
|  | 1427 |  | 
|  | 1428 | // Initialize the buffer to 0xff (pad the buffer) | 
|  | 1429 | memset (buffer, 0xff, buffer_size); | 
|  | 1430 |  | 
|  | 1431 | memcpy (buffer, &PagableOperationalCodeImage[0], PagableOperationalCodeSize); | 
|  | 1432 |  | 
|  | 1433 | for(i = sizeof(struct ti_i2c_image_header); i < buffer_size; i++) { | 
|  | 1434 | cs = (__u8)(cs + buffer[i]); | 
|  | 1435 | } | 
|  | 1436 |  | 
|  | 1437 | header = (struct ti_i2c_image_header *)buffer; | 
|  | 1438 |  | 
|  | 1439 | // update length and checksum after padding | 
|  | 1440 | header->Length 	 = cpu_to_le16((__u16)(buffer_size - sizeof(struct ti_i2c_image_header))); | 
|  | 1441 | header->CheckSum = cs; | 
|  | 1442 |  | 
|  | 1443 | // Download the operational code | 
|  | 1444 | dbg ("%s - Downloading operational code image (TI UMP)", __FUNCTION__); | 
|  | 1445 | status = TIDownloadCodeImage (serial, buffer, buffer_size); | 
|  | 1446 |  | 
|  | 1447 | kfree (buffer); | 
|  | 1448 |  | 
|  | 1449 | if (status) { | 
|  | 1450 | dbg ("%s - Error downloading operational code image", __FUNCTION__); | 
|  | 1451 | return status; | 
|  | 1452 | } | 
|  | 1453 |  | 
|  | 1454 | // Device will reboot | 
|  | 1455 | serial->product_info.TiMode = TI_MODE_TRANSITIONING; | 
|  | 1456 |  | 
|  | 1457 | dbg ("%s - Download successful -- Device rebooting...", __FUNCTION__); | 
|  | 1458 |  | 
|  | 1459 | /* return an error on purpose */ | 
|  | 1460 | return -ENODEV; | 
|  | 1461 | } | 
|  | 1462 |  | 
|  | 1463 | StayInBootMode: | 
|  | 1464 | // Eprom is invalid or blank stay in boot mode | 
|  | 1465 | dbg ("%s - <<<<<<<<<<<<<<<STAYING IN BOOT MODE>>>>>>>>>>>>", __FUNCTION__); | 
|  | 1466 | serial->product_info.TiMode = TI_MODE_BOOT; | 
|  | 1467 |  | 
|  | 1468 | return 0; | 
|  | 1469 | } | 
|  | 1470 |  | 
|  | 1471 |  | 
|  | 1472 | static int TISetDtr (struct edgeport_port *port) | 
|  | 1473 | { | 
|  | 1474 | int port_number = port->port->number - port->port->serial->minor; | 
|  | 1475 |  | 
|  | 1476 | dbg ("%s", __FUNCTION__); | 
|  | 1477 | port->shadow_mcr |= MCR_DTR; | 
|  | 1478 |  | 
|  | 1479 | return TIWriteCommandSync (port->port->serial->dev, | 
|  | 1480 | UMPC_SET_CLR_DTR, | 
|  | 1481 | (__u8)(UMPM_UART1_PORT + port_number), | 
|  | 1482 | 1,	/* set */ | 
|  | 1483 | NULL, | 
|  | 1484 | 0); | 
|  | 1485 | } | 
|  | 1486 |  | 
|  | 1487 | static int TIClearDtr (struct edgeport_port *port) | 
|  | 1488 | { | 
|  | 1489 | int port_number = port->port->number - port->port->serial->minor; | 
|  | 1490 |  | 
|  | 1491 | dbg ("%s", __FUNCTION__); | 
|  | 1492 | port->shadow_mcr &= ~MCR_DTR; | 
|  | 1493 |  | 
|  | 1494 | return TIWriteCommandSync (port->port->serial->dev, | 
|  | 1495 | UMPC_SET_CLR_DTR, | 
|  | 1496 | (__u8)(UMPM_UART1_PORT + port_number), | 
|  | 1497 | 0,	/* clear */ | 
|  | 1498 | NULL, | 
|  | 1499 | 0); | 
|  | 1500 | } | 
|  | 1501 |  | 
|  | 1502 | static int TISetRts (struct edgeport_port *port) | 
|  | 1503 | { | 
|  | 1504 | int port_number = port->port->number - port->port->serial->minor; | 
|  | 1505 |  | 
|  | 1506 | dbg ("%s", __FUNCTION__); | 
|  | 1507 | port->shadow_mcr |= MCR_RTS; | 
|  | 1508 |  | 
|  | 1509 | return TIWriteCommandSync (port->port->serial->dev, | 
|  | 1510 | UMPC_SET_CLR_RTS, | 
|  | 1511 | (__u8)(UMPM_UART1_PORT + port_number), | 
|  | 1512 | 1,	/* set */ | 
|  | 1513 | NULL, | 
|  | 1514 | 0); | 
|  | 1515 | } | 
|  | 1516 |  | 
|  | 1517 | static int TIClearRts (struct edgeport_port *port) | 
|  | 1518 | { | 
|  | 1519 | int port_number = port->port->number - port->port->serial->minor; | 
|  | 1520 |  | 
|  | 1521 | dbg ("%s", __FUNCTION__); | 
|  | 1522 | port->shadow_mcr &= ~MCR_RTS; | 
|  | 1523 |  | 
|  | 1524 | return TIWriteCommandSync (port->port->serial->dev, | 
|  | 1525 | UMPC_SET_CLR_RTS, | 
|  | 1526 | (__u8)(UMPM_UART1_PORT + port_number), | 
|  | 1527 | 0,	/* clear */ | 
|  | 1528 | NULL, | 
|  | 1529 | 0); | 
|  | 1530 | } | 
|  | 1531 |  | 
|  | 1532 | static int TISetLoopBack (struct edgeport_port *port) | 
|  | 1533 | { | 
|  | 1534 | int port_number = port->port->number - port->port->serial->minor; | 
|  | 1535 |  | 
|  | 1536 | dbg ("%s", __FUNCTION__); | 
|  | 1537 |  | 
|  | 1538 | return TIWriteCommandSync (port->port->serial->dev, | 
|  | 1539 | UMPC_SET_CLR_LOOPBACK, | 
|  | 1540 | (__u8)(UMPM_UART1_PORT + port_number), | 
|  | 1541 | 1,	/* set */ | 
|  | 1542 | NULL, | 
|  | 1543 | 0); | 
|  | 1544 | } | 
|  | 1545 |  | 
|  | 1546 | static int TIClearLoopBack (struct edgeport_port *port) | 
|  | 1547 | { | 
|  | 1548 | int port_number = port->port->number - port->port->serial->minor; | 
|  | 1549 |  | 
|  | 1550 | dbg ("%s", __FUNCTION__); | 
|  | 1551 |  | 
|  | 1552 | return TIWriteCommandSync (port->port->serial->dev, | 
|  | 1553 | UMPC_SET_CLR_LOOPBACK, | 
|  | 1554 | (__u8)(UMPM_UART1_PORT + port_number), | 
|  | 1555 | 0,	/* clear */ | 
|  | 1556 | NULL, | 
|  | 1557 | 0); | 
|  | 1558 | } | 
|  | 1559 |  | 
|  | 1560 | static int TISetBreak (struct edgeport_port *port) | 
|  | 1561 | { | 
|  | 1562 | int port_number = port->port->number - port->port->serial->minor; | 
|  | 1563 |  | 
|  | 1564 | dbg ("%s", __FUNCTION__); | 
|  | 1565 |  | 
|  | 1566 | return TIWriteCommandSync (port->port->serial->dev, | 
|  | 1567 | UMPC_SET_CLR_BREAK, | 
|  | 1568 | (__u8)(UMPM_UART1_PORT + port_number), | 
|  | 1569 | 1,	/* set */ | 
|  | 1570 | NULL, | 
|  | 1571 | 0); | 
|  | 1572 | } | 
|  | 1573 |  | 
|  | 1574 | static int TIClearBreak (struct edgeport_port *port) | 
|  | 1575 | { | 
|  | 1576 | int port_number = port->port->number - port->port->serial->minor; | 
|  | 1577 |  | 
|  | 1578 | dbg ("%s", __FUNCTION__); | 
|  | 1579 |  | 
|  | 1580 | return TIWriteCommandSync (port->port->serial->dev, | 
|  | 1581 | UMPC_SET_CLR_BREAK, | 
|  | 1582 | (__u8)(UMPM_UART1_PORT + port_number), | 
|  | 1583 | 0,	/* clear */ | 
|  | 1584 | NULL, | 
|  | 1585 | 0); | 
|  | 1586 | } | 
|  | 1587 |  | 
|  | 1588 | static int TIRestoreMCR (struct edgeport_port *port, __u8 mcr) | 
|  | 1589 | { | 
|  | 1590 | int status = 0; | 
|  | 1591 |  | 
|  | 1592 | dbg ("%s - %x", __FUNCTION__, mcr); | 
|  | 1593 |  | 
|  | 1594 | if (mcr & MCR_DTR) | 
|  | 1595 | status = TISetDtr (port); | 
|  | 1596 | else | 
|  | 1597 | status = TIClearDtr (port); | 
|  | 1598 |  | 
|  | 1599 | if (status) | 
|  | 1600 | return status; | 
|  | 1601 |  | 
|  | 1602 | if (mcr & MCR_RTS) | 
|  | 1603 | status = TISetRts (port); | 
|  | 1604 | else | 
|  | 1605 | status = TIClearRts (port); | 
|  | 1606 |  | 
|  | 1607 | if (status) | 
|  | 1608 | return status; | 
|  | 1609 |  | 
|  | 1610 | if (mcr & MCR_LOOPBACK) | 
|  | 1611 | status = TISetLoopBack (port); | 
|  | 1612 | else | 
|  | 1613 | status = TIClearLoopBack (port); | 
|  | 1614 |  | 
|  | 1615 | return status; | 
|  | 1616 | } | 
|  | 1617 |  | 
|  | 1618 |  | 
|  | 1619 |  | 
|  | 1620 | /* Convert TI LSR to standard UART flags */ | 
|  | 1621 | static __u8 MapLineStatus (__u8 ti_lsr) | 
|  | 1622 | { | 
|  | 1623 | __u8 lsr = 0; | 
|  | 1624 |  | 
|  | 1625 | #define MAP_FLAG(flagUmp, flagUart)    \ | 
|  | 1626 | if (ti_lsr & flagUmp) \ | 
|  | 1627 | lsr |= flagUart; | 
|  | 1628 |  | 
|  | 1629 | MAP_FLAG(UMP_UART_LSR_OV_MASK, LSR_OVER_ERR)	/* overrun */ | 
|  | 1630 | MAP_FLAG(UMP_UART_LSR_PE_MASK, LSR_PAR_ERR)	/* parity error */ | 
|  | 1631 | MAP_FLAG(UMP_UART_LSR_FE_MASK, LSR_FRM_ERR)	/* framing error */ | 
|  | 1632 | MAP_FLAG(UMP_UART_LSR_BR_MASK, LSR_BREAK)	/* break detected */ | 
|  | 1633 | MAP_FLAG(UMP_UART_LSR_RX_MASK, LSR_RX_AVAIL)	/* receive data available */ | 
|  | 1634 | MAP_FLAG(UMP_UART_LSR_TX_MASK, LSR_TX_EMPTY)	/* transmit holding register empty */ | 
|  | 1635 |  | 
|  | 1636 | #undef MAP_FLAG | 
|  | 1637 |  | 
|  | 1638 | return lsr; | 
|  | 1639 | } | 
|  | 1640 |  | 
|  | 1641 | static void handle_new_msr (struct edgeport_port *edge_port, __u8 msr) | 
|  | 1642 | { | 
|  | 1643 | struct async_icount *icount; | 
|  | 1644 | struct tty_struct *tty; | 
|  | 1645 |  | 
|  | 1646 | dbg ("%s - %02x", __FUNCTION__, msr); | 
|  | 1647 |  | 
|  | 1648 | if (msr & (EDGEPORT_MSR_DELTA_CTS | EDGEPORT_MSR_DELTA_DSR | EDGEPORT_MSR_DELTA_RI | EDGEPORT_MSR_DELTA_CD)) { | 
|  | 1649 | icount = &edge_port->icount; | 
|  | 1650 |  | 
|  | 1651 | /* update input line counters */ | 
|  | 1652 | if (msr & EDGEPORT_MSR_DELTA_CTS) | 
|  | 1653 | icount->cts++; | 
|  | 1654 | if (msr & EDGEPORT_MSR_DELTA_DSR) | 
|  | 1655 | icount->dsr++; | 
|  | 1656 | if (msr & EDGEPORT_MSR_DELTA_CD) | 
|  | 1657 | icount->dcd++; | 
|  | 1658 | if (msr & EDGEPORT_MSR_DELTA_RI) | 
|  | 1659 | icount->rng++; | 
|  | 1660 | wake_up_interruptible (&edge_port->delta_msr_wait); | 
|  | 1661 | } | 
|  | 1662 |  | 
|  | 1663 | /* Save the new modem status */ | 
|  | 1664 | edge_port->shadow_msr = msr & 0xf0; | 
|  | 1665 |  | 
|  | 1666 | tty = edge_port->port->tty; | 
|  | 1667 | /* handle CTS flow control */ | 
|  | 1668 | if (tty && C_CRTSCTS(tty)) { | 
|  | 1669 | if (msr & EDGEPORT_MSR_CTS) { | 
|  | 1670 | tty->hw_stopped = 0; | 
|  | 1671 | tty_wakeup(tty); | 
|  | 1672 | } else { | 
|  | 1673 | tty->hw_stopped = 1; | 
|  | 1674 | } | 
|  | 1675 | } | 
|  | 1676 |  | 
|  | 1677 | return; | 
|  | 1678 | } | 
|  | 1679 |  | 
|  | 1680 | static void handle_new_lsr (struct edgeport_port *edge_port, int lsr_data, __u8 lsr, __u8 data) | 
|  | 1681 | { | 
|  | 1682 | struct async_icount *icount; | 
|  | 1683 | __u8 new_lsr = (__u8)(lsr & (__u8)(LSR_OVER_ERR | LSR_PAR_ERR | LSR_FRM_ERR | LSR_BREAK)); | 
|  | 1684 |  | 
|  | 1685 | dbg ("%s - %02x", __FUNCTION__, new_lsr); | 
|  | 1686 |  | 
|  | 1687 | edge_port->shadow_lsr = lsr; | 
|  | 1688 |  | 
|  | 1689 | if (new_lsr & LSR_BREAK) { | 
|  | 1690 | /* | 
|  | 1691 | * Parity and Framing errors only count if they | 
|  | 1692 | * occur exclusive of a break being received. | 
|  | 1693 | */ | 
|  | 1694 | new_lsr &= (__u8)(LSR_OVER_ERR | LSR_BREAK); | 
|  | 1695 | } | 
|  | 1696 |  | 
|  | 1697 | /* Place LSR data byte into Rx buffer */ | 
|  | 1698 | if (lsr_data && edge_port->port->tty) | 
|  | 1699 | edge_tty_recv(&edge_port->port->dev, edge_port->port->tty, &data, 1); | 
|  | 1700 |  | 
|  | 1701 | /* update input line counters */ | 
|  | 1702 | icount = &edge_port->icount; | 
|  | 1703 | if (new_lsr & LSR_BREAK) | 
|  | 1704 | icount->brk++; | 
|  | 1705 | if (new_lsr & LSR_OVER_ERR) | 
|  | 1706 | icount->overrun++; | 
|  | 1707 | if (new_lsr & LSR_PAR_ERR) | 
|  | 1708 | icount->parity++; | 
|  | 1709 | if (new_lsr & LSR_FRM_ERR) | 
|  | 1710 | icount->frame++; | 
|  | 1711 | } | 
|  | 1712 |  | 
|  | 1713 |  | 
| David Howells | 7d12e78 | 2006-10-05 14:55:46 +0100 | [diff] [blame] | 1714 | static void edge_interrupt_callback (struct urb *urb) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1715 | { | 
|  | 1716 | struct edgeport_serial *edge_serial = (struct edgeport_serial *)urb->context; | 
|  | 1717 | struct usb_serial_port *port; | 
|  | 1718 | struct edgeport_port *edge_port; | 
|  | 1719 | unsigned char *data = urb->transfer_buffer; | 
|  | 1720 | int length = urb->actual_length; | 
|  | 1721 | int port_number; | 
|  | 1722 | int function; | 
| Greg Kroah-Hartman | ee337c2 | 2007-06-15 15:44:13 -0700 | [diff] [blame] | 1723 | int retval; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1724 | __u8 lsr; | 
|  | 1725 | __u8 msr; | 
| Greg Kroah-Hartman | ee337c2 | 2007-06-15 15:44:13 -0700 | [diff] [blame] | 1726 | int status = urb->status; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1727 |  | 
|  | 1728 | dbg("%s", __FUNCTION__); | 
|  | 1729 |  | 
| Greg Kroah-Hartman | ee337c2 | 2007-06-15 15:44:13 -0700 | [diff] [blame] | 1730 | switch (status) { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1731 | case 0: | 
|  | 1732 | /* success */ | 
|  | 1733 | break; | 
|  | 1734 | case -ECONNRESET: | 
|  | 1735 | case -ENOENT: | 
|  | 1736 | case -ESHUTDOWN: | 
|  | 1737 | /* this urb is terminated, clean up */ | 
| Greg Kroah-Hartman | ee337c2 | 2007-06-15 15:44:13 -0700 | [diff] [blame] | 1738 | dbg("%s - urb shutting down with status: %d", | 
|  | 1739 | __FUNCTION__, status); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1740 | return; | 
|  | 1741 | default: | 
| Greg Kroah-Hartman | ee337c2 | 2007-06-15 15:44:13 -0700 | [diff] [blame] | 1742 | dev_err(&urb->dev->dev, "%s - nonzero urb status received: " | 
|  | 1743 | "%d\n", __FUNCTION__, status); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1744 | goto exit; | 
|  | 1745 | } | 
|  | 1746 |  | 
|  | 1747 | if (!length) { | 
|  | 1748 | dbg ("%s - no data in urb", __FUNCTION__); | 
|  | 1749 | goto exit; | 
|  | 1750 | } | 
|  | 1751 |  | 
|  | 1752 | usb_serial_debug_data(debug, &edge_serial->serial->dev->dev, __FUNCTION__, length, data); | 
|  | 1753 |  | 
|  | 1754 | if (length != 2) { | 
|  | 1755 | dbg ("%s - expecting packet of size 2, got %d", __FUNCTION__, length); | 
|  | 1756 | goto exit; | 
|  | 1757 | } | 
|  | 1758 |  | 
|  | 1759 | port_number = TIUMP_GET_PORT_FROM_CODE (data[0]); | 
|  | 1760 | function    = TIUMP_GET_FUNC_FROM_CODE (data[0]); | 
|  | 1761 | dbg ("%s - port_number %d, function %d, info 0x%x", | 
|  | 1762 | __FUNCTION__, port_number, function, data[1]); | 
|  | 1763 | port = edge_serial->serial->port[port_number]; | 
|  | 1764 | edge_port = usb_get_serial_port_data(port); | 
|  | 1765 | if (!edge_port) { | 
|  | 1766 | dbg ("%s - edge_port not found", __FUNCTION__); | 
|  | 1767 | return; | 
|  | 1768 | } | 
|  | 1769 | switch (function) { | 
|  | 1770 | case TIUMP_INTERRUPT_CODE_LSR: | 
|  | 1771 | lsr = MapLineStatus(data[1]); | 
|  | 1772 | if (lsr & UMP_UART_LSR_DATA_MASK) { | 
|  | 1773 | /* Save the LSR event for bulk read completion routine */ | 
|  | 1774 | dbg ("%s - LSR Event Port %u LSR Status = %02x", | 
|  | 1775 | __FUNCTION__, port_number, lsr); | 
|  | 1776 | edge_port->lsr_event = 1; | 
|  | 1777 | edge_port->lsr_mask = lsr; | 
|  | 1778 | } else { | 
|  | 1779 | dbg ("%s - ===== Port %d LSR Status = %02x ======", | 
|  | 1780 | __FUNCTION__, port_number, lsr); | 
|  | 1781 | handle_new_lsr (edge_port, 0, lsr, 0); | 
|  | 1782 | } | 
|  | 1783 | break; | 
|  | 1784 |  | 
|  | 1785 | case TIUMP_INTERRUPT_CODE_MSR:	// MSR | 
|  | 1786 | /* Copy MSR from UMP */ | 
|  | 1787 | msr = data[1]; | 
|  | 1788 | dbg ("%s - ===== Port %u MSR Status = %02x ======\n", | 
|  | 1789 | __FUNCTION__, port_number, msr); | 
|  | 1790 | handle_new_msr (edge_port, msr); | 
|  | 1791 | break; | 
|  | 1792 |  | 
|  | 1793 | default: | 
|  | 1794 | dev_err (&urb->dev->dev, "%s - Unknown Interrupt code from UMP %x\n", | 
|  | 1795 | __FUNCTION__, data[1]); | 
|  | 1796 | break; | 
|  | 1797 |  | 
|  | 1798 | } | 
|  | 1799 |  | 
|  | 1800 | exit: | 
| Greg Kroah-Hartman | ee337c2 | 2007-06-15 15:44:13 -0700 | [diff] [blame] | 1801 | retval = usb_submit_urb (urb, GFP_ATOMIC); | 
|  | 1802 | if (retval) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1803 | dev_err (&urb->dev->dev, "%s - usb_submit_urb failed with result %d\n", | 
| Greg Kroah-Hartman | ee337c2 | 2007-06-15 15:44:13 -0700 | [diff] [blame] | 1804 | __FUNCTION__, retval); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1805 | } | 
|  | 1806 |  | 
| David Howells | 7d12e78 | 2006-10-05 14:55:46 +0100 | [diff] [blame] | 1807 | static void edge_bulk_in_callback (struct urb *urb) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1808 | { | 
|  | 1809 | struct edgeport_port *edge_port = (struct edgeport_port *)urb->context; | 
|  | 1810 | unsigned char *data = urb->transfer_buffer; | 
|  | 1811 | struct tty_struct *tty; | 
| Greg Kroah-Hartman | ee337c2 | 2007-06-15 15:44:13 -0700 | [diff] [blame] | 1812 | int retval = 0; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1813 | int port_number; | 
| Greg Kroah-Hartman | ee337c2 | 2007-06-15 15:44:13 -0700 | [diff] [blame] | 1814 | int status = urb->status; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1815 |  | 
|  | 1816 | dbg("%s", __FUNCTION__); | 
|  | 1817 |  | 
| Greg Kroah-Hartman | ee337c2 | 2007-06-15 15:44:13 -0700 | [diff] [blame] | 1818 | switch (status) { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1819 | case 0: | 
|  | 1820 | /* success */ | 
|  | 1821 | break; | 
|  | 1822 | case -ECONNRESET: | 
|  | 1823 | case -ENOENT: | 
|  | 1824 | case -ESHUTDOWN: | 
|  | 1825 | /* this urb is terminated, clean up */ | 
| Greg Kroah-Hartman | ee337c2 | 2007-06-15 15:44:13 -0700 | [diff] [blame] | 1826 | dbg("%s - urb shutting down with status: %d", | 
|  | 1827 | __FUNCTION__, status); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1828 | return; | 
|  | 1829 | default: | 
|  | 1830 | dev_err (&urb->dev->dev,"%s - nonzero read bulk status received: %d\n", | 
| Greg Kroah-Hartman | ee337c2 | 2007-06-15 15:44:13 -0700 | [diff] [blame] | 1831 | __FUNCTION__, status); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1832 | } | 
|  | 1833 |  | 
| Greg Kroah-Hartman | ee337c2 | 2007-06-15 15:44:13 -0700 | [diff] [blame] | 1834 | if (status == -EPIPE) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1835 | goto exit; | 
|  | 1836 |  | 
| Greg Kroah-Hartman | ee337c2 | 2007-06-15 15:44:13 -0700 | [diff] [blame] | 1837 | if (status) { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1838 | dev_err(&urb->dev->dev,"%s - stopping read!\n", __FUNCTION__); | 
|  | 1839 | return; | 
|  | 1840 | } | 
|  | 1841 |  | 
|  | 1842 | port_number = edge_port->port->number - edge_port->port->serial->minor; | 
|  | 1843 |  | 
|  | 1844 | if (edge_port->lsr_event) { | 
|  | 1845 | edge_port->lsr_event = 0; | 
|  | 1846 | dbg ("%s ===== Port %u LSR Status = %02x, Data = %02x ======", | 
|  | 1847 | __FUNCTION__, port_number, edge_port->lsr_mask, *data); | 
|  | 1848 | handle_new_lsr (edge_port, 1, edge_port->lsr_mask, *data); | 
|  | 1849 | /* Adjust buffer length/pointer */ | 
|  | 1850 | --urb->actual_length; | 
|  | 1851 | ++data; | 
|  | 1852 | } | 
|  | 1853 |  | 
|  | 1854 | tty = edge_port->port->tty; | 
|  | 1855 | if (tty && urb->actual_length) { | 
|  | 1856 | usb_serial_debug_data(debug, &edge_port->port->dev, __FUNCTION__, urb->actual_length, data); | 
|  | 1857 |  | 
|  | 1858 | if (edge_port->close_pending) { | 
|  | 1859 | dbg ("%s - close is pending, dropping data on the floor.", __FUNCTION__); | 
|  | 1860 | } else { | 
|  | 1861 | edge_tty_recv(&edge_port->port->dev, tty, data, urb->actual_length); | 
|  | 1862 | } | 
|  | 1863 | edge_port->icount.rx += urb->actual_length; | 
|  | 1864 | } | 
|  | 1865 |  | 
|  | 1866 | exit: | 
|  | 1867 | /* continue read unless stopped */ | 
|  | 1868 | spin_lock(&edge_port->ep_lock); | 
|  | 1869 | if (edge_port->ep_read_urb_state == EDGE_READ_URB_RUNNING) { | 
|  | 1870 | urb->dev = edge_port->port->serial->dev; | 
| Greg Kroah-Hartman | ee337c2 | 2007-06-15 15:44:13 -0700 | [diff] [blame] | 1871 | retval = usb_submit_urb(urb, GFP_ATOMIC); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1872 | } else if (edge_port->ep_read_urb_state == EDGE_READ_URB_STOPPING) { | 
|  | 1873 | edge_port->ep_read_urb_state = EDGE_READ_URB_STOPPED; | 
|  | 1874 | } | 
|  | 1875 | spin_unlock(&edge_port->ep_lock); | 
| Greg Kroah-Hartman | ee337c2 | 2007-06-15 15:44:13 -0700 | [diff] [blame] | 1876 | if (retval) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1877 | dev_err (&urb->dev->dev, "%s - usb_submit_urb failed with result %d\n", | 
| Greg Kroah-Hartman | ee337c2 | 2007-06-15 15:44:13 -0700 | [diff] [blame] | 1878 | __FUNCTION__, retval); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1879 | } | 
|  | 1880 |  | 
|  | 1881 | static void edge_tty_recv(struct device *dev, struct tty_struct *tty, unsigned char *data, int length) | 
|  | 1882 | { | 
|  | 1883 | int cnt; | 
|  | 1884 |  | 
|  | 1885 | do { | 
| Alan Cox | 33f0f88 | 2006-01-09 20:54:13 -0800 | [diff] [blame] | 1886 | cnt = tty_buffer_request_room(tty, length); | 
|  | 1887 | if (cnt < length) { | 
|  | 1888 | dev_err(dev, "%s - dropping data, %d bytes lost\n", | 
|  | 1889 | __FUNCTION__, length - cnt); | 
|  | 1890 | if(cnt == 0) | 
|  | 1891 | break; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1892 | } | 
| Alan Cox | 33f0f88 | 2006-01-09 20:54:13 -0800 | [diff] [blame] | 1893 | tty_insert_flip_string(tty, data, cnt); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1894 | data += cnt; | 
|  | 1895 | length -= cnt; | 
|  | 1896 | } while (length > 0); | 
|  | 1897 |  | 
|  | 1898 | tty_flip_buffer_push(tty); | 
|  | 1899 | } | 
|  | 1900 |  | 
| David Howells | 7d12e78 | 2006-10-05 14:55:46 +0100 | [diff] [blame] | 1901 | static void edge_bulk_out_callback (struct urb *urb) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1902 | { | 
|  | 1903 | struct usb_serial_port *port = (struct usb_serial_port *)urb->context; | 
|  | 1904 | struct edgeport_port *edge_port = usb_get_serial_port_data(port); | 
| Greg Kroah-Hartman | ee337c2 | 2007-06-15 15:44:13 -0700 | [diff] [blame] | 1905 | int status = urb->status; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1906 |  | 
|  | 1907 | dbg ("%s - port %d", __FUNCTION__, port->number); | 
|  | 1908 |  | 
|  | 1909 | edge_port->ep_write_urb_in_use = 0; | 
|  | 1910 |  | 
| Greg Kroah-Hartman | ee337c2 | 2007-06-15 15:44:13 -0700 | [diff] [blame] | 1911 | switch (status) { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1912 | case 0: | 
|  | 1913 | /* success */ | 
|  | 1914 | break; | 
|  | 1915 | case -ECONNRESET: | 
|  | 1916 | case -ENOENT: | 
|  | 1917 | case -ESHUTDOWN: | 
|  | 1918 | /* this urb is terminated, clean up */ | 
| Greg Kroah-Hartman | ee337c2 | 2007-06-15 15:44:13 -0700 | [diff] [blame] | 1919 | dbg("%s - urb shutting down with status: %d", | 
|  | 1920 | __FUNCTION__, status); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1921 | return; | 
|  | 1922 | default: | 
| Greg Kroah-Hartman | ee337c2 | 2007-06-15 15:44:13 -0700 | [diff] [blame] | 1923 | dev_err(&urb->dev->dev, "%s - nonzero write bulk status " | 
|  | 1924 | "received: %d\n", __FUNCTION__, status); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1925 | } | 
|  | 1926 |  | 
|  | 1927 | /* send any buffered data */ | 
|  | 1928 | edge_send(port); | 
|  | 1929 | } | 
|  | 1930 |  | 
|  | 1931 | static int edge_open (struct usb_serial_port *port, struct file * filp) | 
|  | 1932 | { | 
|  | 1933 | struct edgeport_port *edge_port = usb_get_serial_port_data(port); | 
|  | 1934 | struct edgeport_serial *edge_serial; | 
|  | 1935 | struct usb_device *dev; | 
|  | 1936 | struct urb *urb; | 
|  | 1937 | int port_number; | 
|  | 1938 | int status; | 
|  | 1939 | u16 open_settings; | 
|  | 1940 | u8 transaction_timeout; | 
|  | 1941 |  | 
|  | 1942 | dbg("%s - port %d", __FUNCTION__, port->number); | 
|  | 1943 |  | 
|  | 1944 | if (edge_port == NULL) | 
|  | 1945 | return -ENODEV; | 
|  | 1946 |  | 
|  | 1947 | if (port->tty) | 
|  | 1948 | port->tty->low_latency = low_latency; | 
|  | 1949 |  | 
|  | 1950 | port_number = port->number - port->serial->minor; | 
|  | 1951 | switch (port_number) { | 
|  | 1952 | case 0: | 
|  | 1953 | edge_port->uart_base = UMPMEM_BASE_UART1; | 
|  | 1954 | edge_port->dma_address = UMPD_OEDB1_ADDRESS; | 
|  | 1955 | break; | 
|  | 1956 | case 1: | 
|  | 1957 | edge_port->uart_base = UMPMEM_BASE_UART2; | 
|  | 1958 | edge_port->dma_address = UMPD_OEDB2_ADDRESS; | 
|  | 1959 | break; | 
|  | 1960 | default: | 
|  | 1961 | dev_err (&port->dev, "Unknown port number!!!\n"); | 
|  | 1962 | return -ENODEV; | 
|  | 1963 | } | 
|  | 1964 |  | 
|  | 1965 | dbg ("%s - port_number = %d, uart_base = %04x, dma_address = %04x", | 
|  | 1966 | __FUNCTION__, port_number, edge_port->uart_base, edge_port->dma_address); | 
|  | 1967 |  | 
|  | 1968 | dev = port->serial->dev; | 
|  | 1969 |  | 
|  | 1970 | memset (&(edge_port->icount), 0x00, sizeof(edge_port->icount)); | 
|  | 1971 | init_waitqueue_head (&edge_port->delta_msr_wait); | 
|  | 1972 |  | 
|  | 1973 | /* turn off loopback */ | 
|  | 1974 | status = TIClearLoopBack (edge_port); | 
|  | 1975 | if (status) { | 
|  | 1976 | dev_err(&port->dev,"%s - cannot send clear loopback command, %d\n", | 
|  | 1977 | __FUNCTION__, status); | 
|  | 1978 | return status; | 
|  | 1979 | } | 
|  | 1980 |  | 
|  | 1981 | /* set up the port settings */ | 
| Alan Cox | d5f5bcd | 2008-01-03 16:57:33 +0000 | [diff] [blame] | 1982 | edge_set_termios (port, port->tty->termios); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1983 |  | 
|  | 1984 | /* open up the port */ | 
|  | 1985 |  | 
|  | 1986 | /* milliseconds to timeout for DMA transfer */ | 
|  | 1987 | transaction_timeout = 2; | 
|  | 1988 |  | 
|  | 1989 | edge_port->ump_read_timeout = max (20, ((transaction_timeout * 3) / 2) ); | 
|  | 1990 |  | 
|  | 1991 | // milliseconds to timeout for DMA transfer | 
|  | 1992 | open_settings = (u8)(UMP_DMA_MODE_CONTINOUS | | 
|  | 1993 | UMP_PIPE_TRANS_TIMEOUT_ENA | | 
|  | 1994 | (transaction_timeout << 2)); | 
|  | 1995 |  | 
|  | 1996 | dbg ("%s - Sending UMPC_OPEN_PORT", __FUNCTION__); | 
|  | 1997 |  | 
|  | 1998 | /* Tell TI to open and start the port */ | 
|  | 1999 | status = TIWriteCommandSync (dev, | 
|  | 2000 | UMPC_OPEN_PORT, | 
|  | 2001 | (u8)(UMPM_UART1_PORT + port_number), | 
|  | 2002 | open_settings, | 
|  | 2003 | NULL, | 
|  | 2004 | 0); | 
|  | 2005 | if (status) { | 
|  | 2006 | dev_err(&port->dev,"%s - cannot send open command, %d\n", __FUNCTION__, status); | 
|  | 2007 | return status; | 
|  | 2008 | } | 
|  | 2009 |  | 
|  | 2010 | /* Start the DMA? */ | 
|  | 2011 | status = TIWriteCommandSync (dev, | 
|  | 2012 | UMPC_START_PORT, | 
|  | 2013 | (u8)(UMPM_UART1_PORT + port_number), | 
|  | 2014 | 0, | 
|  | 2015 | NULL, | 
|  | 2016 | 0); | 
|  | 2017 | if (status) { | 
|  | 2018 | dev_err(&port->dev,"%s - cannot send start DMA command, %d\n", __FUNCTION__, status); | 
|  | 2019 | return status; | 
|  | 2020 | } | 
|  | 2021 |  | 
|  | 2022 | /* Clear TX and RX buffers in UMP */ | 
|  | 2023 | status = TIPurgeDataSync (port, UMP_PORT_DIR_OUT | UMP_PORT_DIR_IN); | 
|  | 2024 | if (status) { | 
|  | 2025 | dev_err(&port->dev,"%s - cannot send clear buffers command, %d\n", __FUNCTION__, status); | 
|  | 2026 | return status; | 
|  | 2027 | } | 
|  | 2028 |  | 
|  | 2029 | /* Read Initial MSR */ | 
|  | 2030 | status = TIReadVendorRequestSync (dev, | 
|  | 2031 | UMPC_READ_MSR,	// Request | 
|  | 2032 | 0,		// wValue | 
|  | 2033 | (__u16)(UMPM_UART1_PORT + port_number),	// wIndex (Address) | 
|  | 2034 | &edge_port->shadow_msr,			// TransferBuffer | 
|  | 2035 | 1);					// TransferBufferLength | 
|  | 2036 | if (status) { | 
|  | 2037 | dev_err(&port->dev,"%s - cannot send read MSR command, %d\n", __FUNCTION__, status); | 
|  | 2038 | return status; | 
|  | 2039 | } | 
|  | 2040 |  | 
|  | 2041 | dbg ("ShadowMSR 0x%X", edge_port->shadow_msr); | 
|  | 2042 |  | 
|  | 2043 | /* Set Initial MCR */ | 
|  | 2044 | edge_port->shadow_mcr = MCR_RTS | MCR_DTR; | 
|  | 2045 | dbg ("ShadowMCR 0x%X", edge_port->shadow_mcr); | 
|  | 2046 |  | 
|  | 2047 | edge_serial = edge_port->edge_serial; | 
| Matthias Kaehlcke | 241ca64 | 2007-12-04 16:15:40 +0100 | [diff] [blame] | 2048 | if (mutex_lock_interruptible(&edge_serial->es_lock)) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2049 | return -ERESTARTSYS; | 
|  | 2050 | if (edge_serial->num_ports_open == 0) { | 
|  | 2051 | /* we are the first port to be opened, let's post the interrupt urb */ | 
|  | 2052 | urb = edge_serial->serial->port[0]->interrupt_in_urb; | 
|  | 2053 | if (!urb) { | 
|  | 2054 | dev_err (&port->dev, "%s - no interrupt urb present, exiting\n", __FUNCTION__); | 
|  | 2055 | status = -EINVAL; | 
| Matthias Kaehlcke | 241ca64 | 2007-12-04 16:15:40 +0100 | [diff] [blame] | 2056 | goto release_es_lock; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2057 | } | 
|  | 2058 | urb->complete = edge_interrupt_callback; | 
|  | 2059 | urb->context = edge_serial; | 
|  | 2060 | urb->dev = dev; | 
|  | 2061 | status = usb_submit_urb (urb, GFP_KERNEL); | 
|  | 2062 | if (status) { | 
|  | 2063 | dev_err (&port->dev, "%s - usb_submit_urb failed with value %d\n", __FUNCTION__, status); | 
| Matthias Kaehlcke | 241ca64 | 2007-12-04 16:15:40 +0100 | [diff] [blame] | 2064 | goto release_es_lock; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2065 | } | 
|  | 2066 | } | 
|  | 2067 |  | 
|  | 2068 | /* | 
|  | 2069 | * reset the data toggle on the bulk endpoints to work around bug in | 
|  | 2070 | * host controllers where things get out of sync some times | 
|  | 2071 | */ | 
|  | 2072 | usb_clear_halt (dev, port->write_urb->pipe); | 
|  | 2073 | usb_clear_halt (dev, port->read_urb->pipe); | 
|  | 2074 |  | 
|  | 2075 | /* start up our bulk read urb */ | 
|  | 2076 | urb = port->read_urb; | 
|  | 2077 | if (!urb) { | 
|  | 2078 | dev_err (&port->dev, "%s - no read urb present, exiting\n", __FUNCTION__); | 
|  | 2079 | status = -EINVAL; | 
|  | 2080 | goto unlink_int_urb; | 
|  | 2081 | } | 
|  | 2082 | edge_port->ep_read_urb_state = EDGE_READ_URB_RUNNING; | 
|  | 2083 | urb->complete = edge_bulk_in_callback; | 
|  | 2084 | urb->context = edge_port; | 
|  | 2085 | urb->dev = dev; | 
|  | 2086 | status = usb_submit_urb (urb, GFP_KERNEL); | 
|  | 2087 | if (status) { | 
|  | 2088 | dev_err (&port->dev, "%s - read bulk usb_submit_urb failed with value %d\n", __FUNCTION__, status); | 
|  | 2089 | goto unlink_int_urb; | 
|  | 2090 | } | 
|  | 2091 |  | 
|  | 2092 | ++edge_serial->num_ports_open; | 
|  | 2093 |  | 
|  | 2094 | dbg("%s - exited", __FUNCTION__); | 
|  | 2095 |  | 
| Matthias Kaehlcke | 241ca64 | 2007-12-04 16:15:40 +0100 | [diff] [blame] | 2096 | goto release_es_lock; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2097 |  | 
|  | 2098 | unlink_int_urb: | 
|  | 2099 | if (edge_port->edge_serial->num_ports_open == 0) | 
|  | 2100 | usb_kill_urb(port->serial->port[0]->interrupt_in_urb); | 
| Matthias Kaehlcke | 241ca64 | 2007-12-04 16:15:40 +0100 | [diff] [blame] | 2101 | release_es_lock: | 
|  | 2102 | mutex_unlock(&edge_serial->es_lock); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2103 | return status; | 
|  | 2104 | } | 
|  | 2105 |  | 
|  | 2106 | static void edge_close (struct usb_serial_port *port, struct file *filp) | 
|  | 2107 | { | 
|  | 2108 | struct edgeport_serial *edge_serial; | 
|  | 2109 | struct edgeport_port *edge_port; | 
|  | 2110 | int port_number; | 
|  | 2111 | int status; | 
|  | 2112 |  | 
|  | 2113 | dbg("%s - port %d", __FUNCTION__, port->number); | 
|  | 2114 |  | 
|  | 2115 | edge_serial = usb_get_serial_data(port->serial); | 
|  | 2116 | edge_port = usb_get_serial_port_data(port); | 
|  | 2117 | if ((edge_serial == NULL) || (edge_port == NULL)) | 
|  | 2118 | return; | 
|  | 2119 |  | 
|  | 2120 | /* The bulkreadcompletion routine will check | 
|  | 2121 | * this flag and dump add read data */ | 
|  | 2122 | edge_port->close_pending = 1; | 
|  | 2123 |  | 
|  | 2124 | /* chase the port close and flush */ | 
|  | 2125 | TIChasePort (edge_port, (HZ*closing_wait)/100, 1); | 
|  | 2126 |  | 
|  | 2127 | usb_kill_urb(port->read_urb); | 
|  | 2128 | usb_kill_urb(port->write_urb); | 
|  | 2129 | edge_port->ep_write_urb_in_use = 0; | 
|  | 2130 |  | 
|  | 2131 | /* assuming we can still talk to the device, | 
|  | 2132 | * send a close port command to it */ | 
|  | 2133 | dbg("%s - send umpc_close_port", __FUNCTION__); | 
|  | 2134 | port_number = port->number - port->serial->minor; | 
|  | 2135 | status = TIWriteCommandSync (port->serial->dev, | 
|  | 2136 | UMPC_CLOSE_PORT, | 
|  | 2137 | (__u8)(UMPM_UART1_PORT + port_number), | 
|  | 2138 | 0, | 
|  | 2139 | NULL, | 
|  | 2140 | 0); | 
| Matthias Kaehlcke | 241ca64 | 2007-12-04 16:15:40 +0100 | [diff] [blame] | 2141 | mutex_lock(&edge_serial->es_lock); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2142 | --edge_port->edge_serial->num_ports_open; | 
|  | 2143 | if (edge_port->edge_serial->num_ports_open <= 0) { | 
|  | 2144 | /* last port is now closed, let's shut down our interrupt urb */ | 
|  | 2145 | usb_kill_urb(port->serial->port[0]->interrupt_in_urb); | 
|  | 2146 | edge_port->edge_serial->num_ports_open = 0; | 
|  | 2147 | } | 
| Matthias Kaehlcke | 241ca64 | 2007-12-04 16:15:40 +0100 | [diff] [blame] | 2148 | mutex_unlock(&edge_serial->es_lock); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2149 | edge_port->close_pending = 0; | 
|  | 2150 |  | 
|  | 2151 | dbg("%s - exited", __FUNCTION__); | 
|  | 2152 | } | 
|  | 2153 |  | 
|  | 2154 | static int edge_write (struct usb_serial_port *port, const unsigned char *data, int count) | 
|  | 2155 | { | 
|  | 2156 | struct edgeport_port *edge_port = usb_get_serial_port_data(port); | 
|  | 2157 | unsigned long flags; | 
|  | 2158 |  | 
|  | 2159 | dbg("%s - port %d", __FUNCTION__, port->number); | 
|  | 2160 |  | 
|  | 2161 | if (count == 0) { | 
|  | 2162 | dbg("%s - write request of 0 bytes", __FUNCTION__); | 
|  | 2163 | return 0; | 
|  | 2164 | } | 
|  | 2165 |  | 
|  | 2166 | if (edge_port == NULL) | 
|  | 2167 | return -ENODEV; | 
|  | 2168 | if (edge_port->close_pending == 1) | 
|  | 2169 | return -ENODEV; | 
|  | 2170 |  | 
|  | 2171 | spin_lock_irqsave(&edge_port->ep_lock, flags); | 
|  | 2172 | count = edge_buf_put(edge_port->ep_out_buf, data, count); | 
|  | 2173 | spin_unlock_irqrestore(&edge_port->ep_lock, flags); | 
|  | 2174 |  | 
|  | 2175 | edge_send(port); | 
|  | 2176 |  | 
|  | 2177 | return count; | 
|  | 2178 | } | 
|  | 2179 |  | 
|  | 2180 | static void edge_send(struct usb_serial_port *port) | 
|  | 2181 | { | 
|  | 2182 | int count, result; | 
|  | 2183 | struct edgeport_port *edge_port = usb_get_serial_port_data(port); | 
|  | 2184 | struct tty_struct *tty = port->tty; | 
|  | 2185 | unsigned long flags; | 
|  | 2186 |  | 
|  | 2187 |  | 
|  | 2188 | dbg("%s - port %d", __FUNCTION__, port->number); | 
|  | 2189 |  | 
|  | 2190 | spin_lock_irqsave(&edge_port->ep_lock, flags); | 
|  | 2191 |  | 
|  | 2192 | if (edge_port->ep_write_urb_in_use) { | 
|  | 2193 | spin_unlock_irqrestore(&edge_port->ep_lock, flags); | 
|  | 2194 | return; | 
|  | 2195 | } | 
|  | 2196 |  | 
|  | 2197 | count = edge_buf_get(edge_port->ep_out_buf, | 
|  | 2198 | port->write_urb->transfer_buffer, | 
|  | 2199 | port->bulk_out_size); | 
|  | 2200 |  | 
|  | 2201 | if (count == 0) { | 
|  | 2202 | spin_unlock_irqrestore(&edge_port->ep_lock, flags); | 
|  | 2203 | return; | 
|  | 2204 | } | 
|  | 2205 |  | 
|  | 2206 | edge_port->ep_write_urb_in_use = 1; | 
|  | 2207 |  | 
|  | 2208 | spin_unlock_irqrestore(&edge_port->ep_lock, flags); | 
|  | 2209 |  | 
|  | 2210 | usb_serial_debug_data(debug, &port->dev, __FUNCTION__, count, port->write_urb->transfer_buffer); | 
|  | 2211 |  | 
|  | 2212 | /* set up our urb */ | 
|  | 2213 | usb_fill_bulk_urb (port->write_urb, port->serial->dev, | 
|  | 2214 | usb_sndbulkpipe (port->serial->dev, | 
|  | 2215 | port->bulk_out_endpointAddress), | 
|  | 2216 | port->write_urb->transfer_buffer, count, | 
|  | 2217 | edge_bulk_out_callback, | 
|  | 2218 | port); | 
|  | 2219 |  | 
|  | 2220 | /* send the data out the bulk port */ | 
|  | 2221 | result = usb_submit_urb(port->write_urb, GFP_ATOMIC); | 
|  | 2222 | if (result) { | 
|  | 2223 | dev_err(&port->dev, "%s - failed submitting write urb, error %d\n", __FUNCTION__, result); | 
|  | 2224 | edge_port->ep_write_urb_in_use = 0; | 
|  | 2225 | // TODO: reschedule edge_send | 
|  | 2226 | } else { | 
|  | 2227 | edge_port->icount.tx += count; | 
|  | 2228 | } | 
|  | 2229 |  | 
|  | 2230 | /* wakeup any process waiting for writes to complete */ | 
|  | 2231 | /* there is now more room in the buffer for new writes */ | 
|  | 2232 | if (tty) { | 
|  | 2233 | /* let the tty driver wakeup if it has a special write_wakeup function */ | 
|  | 2234 | tty_wakeup(tty); | 
|  | 2235 | } | 
|  | 2236 | } | 
|  | 2237 |  | 
|  | 2238 | static int edge_write_room (struct usb_serial_port *port) | 
|  | 2239 | { | 
|  | 2240 | struct edgeport_port *edge_port = usb_get_serial_port_data(port); | 
|  | 2241 | int room = 0; | 
|  | 2242 | unsigned long flags; | 
|  | 2243 |  | 
|  | 2244 | dbg("%s - port %d", __FUNCTION__, port->number); | 
|  | 2245 |  | 
|  | 2246 | if (edge_port == NULL) | 
|  | 2247 | return -ENODEV; | 
|  | 2248 | if (edge_port->close_pending == 1) | 
|  | 2249 | return -ENODEV; | 
|  | 2250 |  | 
|  | 2251 | spin_lock_irqsave(&edge_port->ep_lock, flags); | 
|  | 2252 | room = edge_buf_space_avail(edge_port->ep_out_buf); | 
|  | 2253 | spin_unlock_irqrestore(&edge_port->ep_lock, flags); | 
|  | 2254 |  | 
|  | 2255 | dbg("%s - returns %d", __FUNCTION__, room); | 
|  | 2256 | return room; | 
|  | 2257 | } | 
|  | 2258 |  | 
|  | 2259 | static int edge_chars_in_buffer (struct usb_serial_port *port) | 
|  | 2260 | { | 
|  | 2261 | struct edgeport_port *edge_port = usb_get_serial_port_data(port); | 
|  | 2262 | int chars = 0; | 
|  | 2263 | unsigned long flags; | 
|  | 2264 |  | 
|  | 2265 | dbg("%s - port %d", __FUNCTION__, port->number); | 
|  | 2266 |  | 
|  | 2267 | if (edge_port == NULL) | 
|  | 2268 | return -ENODEV; | 
|  | 2269 | if (edge_port->close_pending == 1) | 
|  | 2270 | return -ENODEV; | 
|  | 2271 |  | 
|  | 2272 | spin_lock_irqsave(&edge_port->ep_lock, flags); | 
|  | 2273 | chars = edge_buf_data_avail(edge_port->ep_out_buf); | 
|  | 2274 | spin_unlock_irqrestore(&edge_port->ep_lock, flags); | 
|  | 2275 |  | 
|  | 2276 | dbg ("%s - returns %d", __FUNCTION__, chars); | 
|  | 2277 | return chars; | 
|  | 2278 | } | 
|  | 2279 |  | 
|  | 2280 | static void edge_throttle (struct usb_serial_port *port) | 
|  | 2281 | { | 
|  | 2282 | struct edgeport_port *edge_port = usb_get_serial_port_data(port); | 
|  | 2283 | struct tty_struct *tty; | 
|  | 2284 | int status; | 
|  | 2285 |  | 
|  | 2286 | dbg("%s - port %d", __FUNCTION__, port->number); | 
|  | 2287 |  | 
|  | 2288 | if (edge_port == NULL) | 
|  | 2289 | return; | 
|  | 2290 |  | 
|  | 2291 | tty = port->tty; | 
|  | 2292 | if (!tty) { | 
|  | 2293 | dbg ("%s - no tty available", __FUNCTION__); | 
|  | 2294 | return; | 
|  | 2295 | } | 
|  | 2296 |  | 
|  | 2297 | /* if we are implementing XON/XOFF, send the stop character */ | 
|  | 2298 | if (I_IXOFF(tty)) { | 
|  | 2299 | unsigned char stop_char = STOP_CHAR(tty); | 
|  | 2300 | status = edge_write (port, &stop_char, 1); | 
|  | 2301 | if (status <= 0) { | 
|  | 2302 | dev_err(&port->dev, "%s - failed to write stop character, %d\n", __FUNCTION__, status); | 
|  | 2303 | } | 
|  | 2304 | } | 
|  | 2305 |  | 
|  | 2306 | /* if we are implementing RTS/CTS, stop reads */ | 
|  | 2307 | /* and the Edgeport will clear the RTS line */ | 
|  | 2308 | if (C_CRTSCTS(tty)) | 
|  | 2309 | stop_read(edge_port); | 
|  | 2310 |  | 
|  | 2311 | } | 
|  | 2312 |  | 
|  | 2313 | static void edge_unthrottle (struct usb_serial_port *port) | 
|  | 2314 | { | 
|  | 2315 | struct edgeport_port *edge_port = usb_get_serial_port_data(port); | 
|  | 2316 | struct tty_struct *tty; | 
|  | 2317 | int status; | 
|  | 2318 |  | 
|  | 2319 | dbg("%s - port %d", __FUNCTION__, port->number); | 
|  | 2320 |  | 
|  | 2321 | if (edge_port == NULL) | 
|  | 2322 | return; | 
|  | 2323 |  | 
|  | 2324 | tty = port->tty; | 
|  | 2325 | if (!tty) { | 
|  | 2326 | dbg ("%s - no tty available", __FUNCTION__); | 
|  | 2327 | return; | 
|  | 2328 | } | 
|  | 2329 |  | 
|  | 2330 | /* if we are implementing XON/XOFF, send the start character */ | 
|  | 2331 | if (I_IXOFF(tty)) { | 
|  | 2332 | unsigned char start_char = START_CHAR(tty); | 
|  | 2333 | status = edge_write (port, &start_char, 1); | 
|  | 2334 | if (status <= 0) { | 
|  | 2335 | dev_err(&port->dev, "%s - failed to write start character, %d\n", __FUNCTION__, status); | 
|  | 2336 | } | 
|  | 2337 | } | 
|  | 2338 |  | 
|  | 2339 | /* if we are implementing RTS/CTS, restart reads */ | 
|  | 2340 | /* are the Edgeport will assert the RTS line */ | 
|  | 2341 | if (C_CRTSCTS(tty)) { | 
|  | 2342 | status = restart_read(edge_port); | 
|  | 2343 | if (status) | 
|  | 2344 | dev_err(&port->dev, "%s - read bulk usb_submit_urb failed with value %d\n", __FUNCTION__, status); | 
|  | 2345 | } | 
|  | 2346 |  | 
|  | 2347 | } | 
|  | 2348 |  | 
|  | 2349 | static void stop_read(struct edgeport_port *edge_port) | 
|  | 2350 | { | 
|  | 2351 | unsigned long flags; | 
|  | 2352 |  | 
|  | 2353 | spin_lock_irqsave(&edge_port->ep_lock, flags); | 
|  | 2354 |  | 
|  | 2355 | if (edge_port->ep_read_urb_state == EDGE_READ_URB_RUNNING) | 
|  | 2356 | edge_port->ep_read_urb_state = EDGE_READ_URB_STOPPING; | 
|  | 2357 | edge_port->shadow_mcr &= ~MCR_RTS; | 
|  | 2358 |  | 
|  | 2359 | spin_unlock_irqrestore(&edge_port->ep_lock, flags); | 
|  | 2360 | } | 
|  | 2361 |  | 
|  | 2362 | static int restart_read(struct edgeport_port *edge_port) | 
|  | 2363 | { | 
|  | 2364 | struct urb *urb; | 
|  | 2365 | int status = 0; | 
|  | 2366 | unsigned long flags; | 
|  | 2367 |  | 
|  | 2368 | spin_lock_irqsave(&edge_port->ep_lock, flags); | 
|  | 2369 |  | 
|  | 2370 | if (edge_port->ep_read_urb_state == EDGE_READ_URB_STOPPED) { | 
|  | 2371 | urb = edge_port->port->read_urb; | 
|  | 2372 | urb->complete = edge_bulk_in_callback; | 
|  | 2373 | urb->context = edge_port; | 
|  | 2374 | urb->dev = edge_port->port->serial->dev; | 
| Oliver Neukum | efdff60 | 2007-06-05 10:50:48 +0200 | [diff] [blame] | 2375 | status = usb_submit_urb(urb, GFP_ATOMIC); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2376 | } | 
|  | 2377 | edge_port->ep_read_urb_state = EDGE_READ_URB_RUNNING; | 
|  | 2378 | edge_port->shadow_mcr |= MCR_RTS; | 
|  | 2379 |  | 
|  | 2380 | spin_unlock_irqrestore(&edge_port->ep_lock, flags); | 
|  | 2381 |  | 
|  | 2382 | return status; | 
|  | 2383 | } | 
|  | 2384 |  | 
| Alan Cox | 606d099 | 2006-12-08 02:38:45 -0800 | [diff] [blame] | 2385 | static void change_port_settings (struct edgeport_port *edge_port, struct ktermios *old_termios) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2386 | { | 
|  | 2387 | struct ump_uart_config *config; | 
|  | 2388 | struct tty_struct *tty; | 
|  | 2389 | int baud; | 
|  | 2390 | unsigned cflag; | 
|  | 2391 | int status; | 
|  | 2392 | int port_number = edge_port->port->number - edge_port->port->serial->minor; | 
|  | 2393 |  | 
|  | 2394 | dbg("%s - port %d", __FUNCTION__, edge_port->port->number); | 
|  | 2395 |  | 
|  | 2396 | tty = edge_port->port->tty; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2397 |  | 
|  | 2398 | config = kmalloc (sizeof (*config), GFP_KERNEL); | 
|  | 2399 | if (!config) { | 
|  | 2400 | dev_err (&edge_port->port->dev, "%s - out of memory\n", __FUNCTION__); | 
|  | 2401 | return; | 
|  | 2402 | } | 
|  | 2403 |  | 
|  | 2404 | cflag = tty->termios->c_cflag; | 
|  | 2405 |  | 
|  | 2406 | config->wFlags = 0; | 
|  | 2407 |  | 
|  | 2408 | /* These flags must be set */ | 
|  | 2409 | config->wFlags |= UMP_MASK_UART_FLAGS_RECEIVE_MS_INT; | 
|  | 2410 | config->wFlags |= UMP_MASK_UART_FLAGS_AUTO_START_ON_ERR; | 
|  | 2411 | config->bUartMode = (__u8)(edge_port->bUartMode); | 
|  | 2412 |  | 
|  | 2413 | switch (cflag & CSIZE) { | 
|  | 2414 | case CS5: | 
|  | 2415 | config->bDataBits = UMP_UART_CHAR5BITS; | 
|  | 2416 | dbg ("%s - data bits = 5", __FUNCTION__); | 
|  | 2417 | break; | 
|  | 2418 | case CS6: | 
|  | 2419 | config->bDataBits = UMP_UART_CHAR6BITS; | 
|  | 2420 | dbg ("%s - data bits = 6", __FUNCTION__); | 
|  | 2421 | break; | 
|  | 2422 | case CS7: | 
|  | 2423 | config->bDataBits = UMP_UART_CHAR7BITS; | 
|  | 2424 | dbg ("%s - data bits = 7", __FUNCTION__); | 
|  | 2425 | break; | 
|  | 2426 | default: | 
|  | 2427 | case CS8: | 
|  | 2428 | config->bDataBits = UMP_UART_CHAR8BITS; | 
|  | 2429 | dbg ("%s - data bits = 8", __FUNCTION__); | 
|  | 2430 | break; | 
|  | 2431 | } | 
|  | 2432 |  | 
|  | 2433 | if (cflag & PARENB) { | 
|  | 2434 | if (cflag & PARODD) { | 
|  | 2435 | config->wFlags |= UMP_MASK_UART_FLAGS_PARITY; | 
|  | 2436 | config->bParity = UMP_UART_ODDPARITY; | 
|  | 2437 | dbg("%s - parity = odd", __FUNCTION__); | 
|  | 2438 | } else { | 
|  | 2439 | config->wFlags |= UMP_MASK_UART_FLAGS_PARITY; | 
|  | 2440 | config->bParity = UMP_UART_EVENPARITY; | 
|  | 2441 | dbg("%s - parity = even", __FUNCTION__); | 
|  | 2442 | } | 
|  | 2443 | } else { | 
|  | 2444 | config->bParity = UMP_UART_NOPARITY; | 
|  | 2445 | dbg("%s - parity = none", __FUNCTION__); | 
|  | 2446 | } | 
|  | 2447 |  | 
|  | 2448 | if (cflag & CSTOPB) { | 
|  | 2449 | config->bStopBits = UMP_UART_STOPBIT2; | 
|  | 2450 | dbg("%s - stop bits = 2", __FUNCTION__); | 
|  | 2451 | } else { | 
|  | 2452 | config->bStopBits = UMP_UART_STOPBIT1; | 
|  | 2453 | dbg("%s - stop bits = 1", __FUNCTION__); | 
|  | 2454 | } | 
|  | 2455 |  | 
|  | 2456 | /* figure out the flow control settings */ | 
|  | 2457 | if (cflag & CRTSCTS) { | 
|  | 2458 | config->wFlags |= UMP_MASK_UART_FLAGS_OUT_X_CTS_FLOW; | 
|  | 2459 | config->wFlags |= UMP_MASK_UART_FLAGS_RTS_FLOW; | 
|  | 2460 | dbg("%s - RTS/CTS is enabled", __FUNCTION__); | 
|  | 2461 | } else { | 
|  | 2462 | dbg("%s - RTS/CTS is disabled", __FUNCTION__); | 
|  | 2463 | tty->hw_stopped = 0; | 
|  | 2464 | restart_read(edge_port); | 
|  | 2465 | } | 
|  | 2466 |  | 
|  | 2467 | /* if we are implementing XON/XOFF, set the start and stop character in the device */ | 
|  | 2468 | if (I_IXOFF(tty) || I_IXON(tty)) { | 
|  | 2469 | config->cXon  = START_CHAR(tty); | 
|  | 2470 | config->cXoff = STOP_CHAR(tty); | 
|  | 2471 |  | 
|  | 2472 | /* if we are implementing INBOUND XON/XOFF */ | 
|  | 2473 | if (I_IXOFF(tty)) { | 
|  | 2474 | config->wFlags |= UMP_MASK_UART_FLAGS_IN_X; | 
|  | 2475 | dbg ("%s - INBOUND XON/XOFF is enabled, XON = %2x, XOFF = %2x", | 
|  | 2476 | __FUNCTION__, config->cXon, config->cXoff); | 
|  | 2477 | } else { | 
|  | 2478 | dbg ("%s - INBOUND XON/XOFF is disabled", __FUNCTION__); | 
|  | 2479 | } | 
|  | 2480 |  | 
|  | 2481 | /* if we are implementing OUTBOUND XON/XOFF */ | 
|  | 2482 | if (I_IXON(tty)) { | 
|  | 2483 | config->wFlags |= UMP_MASK_UART_FLAGS_OUT_X; | 
|  | 2484 | dbg ("%s - OUTBOUND XON/XOFF is enabled, XON = %2x, XOFF = %2x", | 
|  | 2485 | __FUNCTION__, config->cXon, config->cXoff); | 
|  | 2486 | } else { | 
|  | 2487 | dbg ("%s - OUTBOUND XON/XOFF is disabled", __FUNCTION__); | 
|  | 2488 | } | 
|  | 2489 | } | 
|  | 2490 |  | 
| Alan Cox | d5f5bcd | 2008-01-03 16:57:33 +0000 | [diff] [blame] | 2491 | tty->termios->c_cflag &= ~CMSPAR; | 
|  | 2492 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2493 | /* Round the baud rate */ | 
|  | 2494 | baud = tty_get_baud_rate(tty); | 
|  | 2495 | if (!baud) { | 
|  | 2496 | /* pick a default, any default... */ | 
|  | 2497 | baud = 9600; | 
| Alan Cox | d5f5bcd | 2008-01-03 16:57:33 +0000 | [diff] [blame] | 2498 | } else | 
|  | 2499 | tty_encode_baud_rate(tty, baud, baud); | 
|  | 2500 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2501 | edge_port->baud_rate = baud; | 
|  | 2502 | config->wBaudRate = (__u16)((461550L + baud/2) / baud); | 
|  | 2503 |  | 
| Alan Cox | d5f5bcd | 2008-01-03 16:57:33 +0000 | [diff] [blame] | 2504 | /* FIXME: Recompute actual baud from divisor here */ | 
|  | 2505 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2506 | dbg ("%s - baud rate = %d, wBaudRate = %d", __FUNCTION__, baud, config->wBaudRate); | 
|  | 2507 |  | 
|  | 2508 | dbg ("wBaudRate:   %d", (int)(461550L / config->wBaudRate)); | 
|  | 2509 | dbg ("wFlags:    0x%x", config->wFlags); | 
|  | 2510 | dbg ("bDataBits:   %d", config->bDataBits); | 
|  | 2511 | dbg ("bParity:     %d", config->bParity); | 
|  | 2512 | dbg ("bStopBits:   %d", config->bStopBits); | 
|  | 2513 | dbg ("cXon:        %d", config->cXon); | 
|  | 2514 | dbg ("cXoff:       %d", config->cXoff); | 
|  | 2515 | dbg ("bUartMode:   %d", config->bUartMode); | 
|  | 2516 |  | 
|  | 2517 | /* move the word values into big endian mode */ | 
|  | 2518 | cpu_to_be16s (&config->wFlags); | 
|  | 2519 | cpu_to_be16s (&config->wBaudRate); | 
|  | 2520 |  | 
|  | 2521 | status = TIWriteCommandSync (edge_port->port->serial->dev, | 
|  | 2522 | UMPC_SET_CONFIG, | 
|  | 2523 | (__u8)(UMPM_UART1_PORT + port_number), | 
|  | 2524 | 0, | 
|  | 2525 | (__u8 *)config, | 
|  | 2526 | sizeof(*config)); | 
|  | 2527 | if (status) { | 
|  | 2528 | dbg ("%s - error %d when trying to write config to device", | 
|  | 2529 | __FUNCTION__, status); | 
|  | 2530 | } | 
|  | 2531 |  | 
|  | 2532 | kfree (config); | 
|  | 2533 |  | 
|  | 2534 | return; | 
|  | 2535 | } | 
|  | 2536 |  | 
| Alan Cox | 606d099 | 2006-12-08 02:38:45 -0800 | [diff] [blame] | 2537 | static void edge_set_termios (struct usb_serial_port *port, struct ktermios *old_termios) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2538 | { | 
|  | 2539 | struct edgeport_port *edge_port = usb_get_serial_port_data(port); | 
|  | 2540 | struct tty_struct *tty = port->tty; | 
|  | 2541 | unsigned int cflag; | 
|  | 2542 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2543 | cflag = tty->termios->c_cflag; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2544 |  | 
|  | 2545 | dbg("%s - clfag %08x iflag %08x", __FUNCTION__, | 
|  | 2546 | tty->termios->c_cflag, tty->termios->c_iflag); | 
| Alan Cox | d5f5bcd | 2008-01-03 16:57:33 +0000 | [diff] [blame] | 2547 | dbg("%s - old clfag %08x old iflag %08x", __FUNCTION__, | 
|  | 2548 | old_termios->c_cflag, old_termios->c_iflag); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2549 |  | 
|  | 2550 | dbg("%s - port %d", __FUNCTION__, port->number); | 
|  | 2551 |  | 
|  | 2552 | if (edge_port == NULL) | 
|  | 2553 | return; | 
|  | 2554 |  | 
|  | 2555 | /* change the port settings to the new ones specified */ | 
|  | 2556 | change_port_settings (edge_port, old_termios); | 
|  | 2557 |  | 
|  | 2558 | return; | 
|  | 2559 | } | 
|  | 2560 |  | 
|  | 2561 | static int edge_tiocmset (struct usb_serial_port *port, struct file *file, unsigned int set, unsigned int clear) | 
|  | 2562 | { | 
|  | 2563 | struct edgeport_port *edge_port = usb_get_serial_port_data(port); | 
|  | 2564 | unsigned int mcr; | 
|  | 2565 |  | 
|  | 2566 | dbg("%s - port %d", __FUNCTION__, port->number); | 
|  | 2567 |  | 
|  | 2568 | mcr = edge_port->shadow_mcr; | 
|  | 2569 | if (set & TIOCM_RTS) | 
|  | 2570 | mcr |= MCR_RTS; | 
|  | 2571 | if (set & TIOCM_DTR) | 
|  | 2572 | mcr |= MCR_DTR; | 
|  | 2573 | if (set & TIOCM_LOOP) | 
|  | 2574 | mcr |= MCR_LOOPBACK; | 
|  | 2575 |  | 
|  | 2576 | if (clear & TIOCM_RTS) | 
|  | 2577 | mcr &= ~MCR_RTS; | 
|  | 2578 | if (clear & TIOCM_DTR) | 
|  | 2579 | mcr &= ~MCR_DTR; | 
|  | 2580 | if (clear & TIOCM_LOOP) | 
|  | 2581 | mcr &= ~MCR_LOOPBACK; | 
|  | 2582 |  | 
|  | 2583 | edge_port->shadow_mcr = mcr; | 
|  | 2584 |  | 
|  | 2585 | TIRestoreMCR (edge_port, mcr); | 
|  | 2586 |  | 
|  | 2587 | return 0; | 
|  | 2588 | } | 
|  | 2589 |  | 
|  | 2590 | static int edge_tiocmget(struct usb_serial_port *port, struct file *file) | 
|  | 2591 | { | 
|  | 2592 | struct edgeport_port *edge_port = usb_get_serial_port_data(port); | 
|  | 2593 | unsigned int result = 0; | 
|  | 2594 | unsigned int msr; | 
|  | 2595 | unsigned int mcr; | 
|  | 2596 |  | 
|  | 2597 | dbg("%s - port %d", __FUNCTION__, port->number); | 
|  | 2598 |  | 
|  | 2599 | msr = edge_port->shadow_msr; | 
|  | 2600 | mcr = edge_port->shadow_mcr; | 
|  | 2601 | result = ((mcr & MCR_DTR)	? TIOCM_DTR: 0)	  /* 0x002 */ | 
|  | 2602 | | ((mcr & MCR_RTS)	? TIOCM_RTS: 0)   /* 0x004 */ | 
|  | 2603 | | ((msr & EDGEPORT_MSR_CTS)	? TIOCM_CTS: 0)   /* 0x020 */ | 
|  | 2604 | | ((msr & EDGEPORT_MSR_CD)	? TIOCM_CAR: 0)   /* 0x040 */ | 
|  | 2605 | | ((msr & EDGEPORT_MSR_RI)	? TIOCM_RI:  0)   /* 0x080 */ | 
|  | 2606 | | ((msr & EDGEPORT_MSR_DSR)	? TIOCM_DSR: 0);  /* 0x100 */ | 
|  | 2607 |  | 
|  | 2608 |  | 
|  | 2609 | dbg("%s -- %x", __FUNCTION__, result); | 
|  | 2610 |  | 
|  | 2611 | return result; | 
|  | 2612 | } | 
|  | 2613 |  | 
|  | 2614 | static int get_serial_info (struct edgeport_port *edge_port, struct serial_struct __user *retinfo) | 
|  | 2615 | { | 
|  | 2616 | struct serial_struct tmp; | 
|  | 2617 |  | 
|  | 2618 | if (!retinfo) | 
|  | 2619 | return -EFAULT; | 
|  | 2620 |  | 
|  | 2621 | memset(&tmp, 0, sizeof(tmp)); | 
|  | 2622 |  | 
|  | 2623 | tmp.type		= PORT_16550A; | 
|  | 2624 | tmp.line		= edge_port->port->serial->minor; | 
|  | 2625 | tmp.port		= edge_port->port->number; | 
|  | 2626 | tmp.irq			= 0; | 
|  | 2627 | tmp.flags		= ASYNC_SKIP_TEST | ASYNC_AUTO_IRQ; | 
|  | 2628 | tmp.xmit_fifo_size	= edge_port->port->bulk_out_size; | 
|  | 2629 | tmp.baud_base		= 9600; | 
|  | 2630 | tmp.close_delay		= 5*HZ; | 
|  | 2631 | tmp.closing_wait	= closing_wait; | 
|  | 2632 | //	tmp.custom_divisor	= state->custom_divisor; | 
|  | 2633 | //	tmp.hub6		= state->hub6; | 
|  | 2634 | //	tmp.io_type		= state->io_type; | 
|  | 2635 |  | 
|  | 2636 |  | 
|  | 2637 | if (copy_to_user(retinfo, &tmp, sizeof(*retinfo))) | 
|  | 2638 | return -EFAULT; | 
|  | 2639 | return 0; | 
|  | 2640 | } | 
|  | 2641 |  | 
|  | 2642 | static int edge_ioctl (struct usb_serial_port *port, struct file *file, unsigned int cmd, unsigned long arg) | 
|  | 2643 | { | 
|  | 2644 | struct edgeport_port *edge_port = usb_get_serial_port_data(port); | 
|  | 2645 | struct async_icount cnow; | 
|  | 2646 | struct async_icount cprev; | 
|  | 2647 |  | 
|  | 2648 | dbg("%s - port %d, cmd = 0x%x", __FUNCTION__, port->number, cmd); | 
|  | 2649 |  | 
|  | 2650 | switch (cmd) { | 
|  | 2651 | case TIOCINQ: | 
|  | 2652 | dbg("%s - (%d) TIOCINQ", __FUNCTION__, port->number); | 
|  | 2653 | //			return get_number_bytes_avail(edge_port, (unsigned int *) arg); | 
|  | 2654 | break; | 
|  | 2655 |  | 
|  | 2656 | case TIOCSERGETLSR: | 
|  | 2657 | dbg("%s - (%d) TIOCSERGETLSR", __FUNCTION__, port->number); | 
|  | 2658 | //			return get_lsr_info(edge_port, (unsigned int *) arg); | 
|  | 2659 | break; | 
|  | 2660 |  | 
|  | 2661 | case TIOCGSERIAL: | 
|  | 2662 | dbg("%s - (%d) TIOCGSERIAL", __FUNCTION__, port->number); | 
|  | 2663 | return get_serial_info(edge_port, (struct serial_struct __user *) arg); | 
|  | 2664 | break; | 
|  | 2665 |  | 
|  | 2666 | case TIOCSSERIAL: | 
|  | 2667 | dbg("%s - (%d) TIOCSSERIAL", __FUNCTION__, port->number); | 
|  | 2668 | break; | 
|  | 2669 |  | 
|  | 2670 | case TIOCMIWAIT: | 
|  | 2671 | dbg("%s - (%d) TIOCMIWAIT", __FUNCTION__, port->number); | 
|  | 2672 | cprev = edge_port->icount; | 
|  | 2673 | while (1) { | 
|  | 2674 | interruptible_sleep_on(&edge_port->delta_msr_wait); | 
|  | 2675 | /* see if a signal did it */ | 
|  | 2676 | if (signal_pending(current)) | 
|  | 2677 | return -ERESTARTSYS; | 
|  | 2678 | cnow = edge_port->icount; | 
|  | 2679 | if (cnow.rng == cprev.rng && cnow.dsr == cprev.dsr && | 
|  | 2680 | cnow.dcd == cprev.dcd && cnow.cts == cprev.cts) | 
|  | 2681 | return -EIO; /* no change => error */ | 
|  | 2682 | if (((arg & TIOCM_RNG) && (cnow.rng != cprev.rng)) || | 
|  | 2683 | ((arg & TIOCM_DSR) && (cnow.dsr != cprev.dsr)) || | 
|  | 2684 | ((arg & TIOCM_CD)  && (cnow.dcd != cprev.dcd)) || | 
|  | 2685 | ((arg & TIOCM_CTS) && (cnow.cts != cprev.cts)) ) { | 
|  | 2686 | return 0; | 
|  | 2687 | } | 
|  | 2688 | cprev = cnow; | 
|  | 2689 | } | 
|  | 2690 | /* not reached */ | 
|  | 2691 | break; | 
|  | 2692 |  | 
|  | 2693 | case TIOCGICOUNT: | 
|  | 2694 | dbg ("%s - (%d) TIOCGICOUNT RX=%d, TX=%d", __FUNCTION__, | 
|  | 2695 | port->number, edge_port->icount.rx, edge_port->icount.tx); | 
|  | 2696 | if (copy_to_user((void __user *)arg, &edge_port->icount, sizeof(edge_port->icount))) | 
|  | 2697 | return -EFAULT; | 
|  | 2698 | return 0; | 
|  | 2699 | } | 
|  | 2700 |  | 
|  | 2701 | return -ENOIOCTLCMD; | 
|  | 2702 | } | 
|  | 2703 |  | 
|  | 2704 | static void edge_break (struct usb_serial_port *port, int break_state) | 
|  | 2705 | { | 
|  | 2706 | struct edgeport_port *edge_port = usb_get_serial_port_data(port); | 
|  | 2707 | int status; | 
|  | 2708 |  | 
|  | 2709 | dbg ("%s - state = %d", __FUNCTION__, break_state); | 
|  | 2710 |  | 
|  | 2711 | /* chase the port close */ | 
|  | 2712 | TIChasePort (edge_port, 0, 0); | 
|  | 2713 |  | 
|  | 2714 | if (break_state == -1) { | 
|  | 2715 | status = TISetBreak (edge_port); | 
|  | 2716 | } else { | 
|  | 2717 | status = TIClearBreak (edge_port); | 
|  | 2718 | } | 
|  | 2719 | if (status) { | 
|  | 2720 | dbg ("%s - error %d sending break set/clear command.", | 
|  | 2721 | __FUNCTION__, status); | 
|  | 2722 | } | 
|  | 2723 | } | 
|  | 2724 |  | 
|  | 2725 | static int edge_startup (struct usb_serial *serial) | 
|  | 2726 | { | 
|  | 2727 | struct edgeport_serial *edge_serial; | 
|  | 2728 | struct edgeport_port *edge_port; | 
|  | 2729 | struct usb_device *dev; | 
|  | 2730 | int status; | 
|  | 2731 | int i; | 
|  | 2732 |  | 
|  | 2733 | dev = serial->dev; | 
|  | 2734 |  | 
|  | 2735 | /* create our private serial structure */ | 
| Eric Sesterhenn | 80b6ca4 | 2006-02-27 21:29:43 +0100 | [diff] [blame] | 2736 | edge_serial = kzalloc(sizeof(struct edgeport_serial), GFP_KERNEL); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2737 | if (edge_serial == NULL) { | 
|  | 2738 | dev_err(&serial->dev->dev, "%s - Out of memory\n", __FUNCTION__); | 
|  | 2739 | return -ENOMEM; | 
|  | 2740 | } | 
| Matthias Kaehlcke | 241ca64 | 2007-12-04 16:15:40 +0100 | [diff] [blame] | 2741 | mutex_init(&edge_serial->es_lock); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2742 | edge_serial->serial = serial; | 
|  | 2743 | usb_set_serial_data(serial, edge_serial); | 
|  | 2744 |  | 
|  | 2745 | status = TIDownloadFirmware (edge_serial); | 
|  | 2746 | if (status) { | 
|  | 2747 | kfree (edge_serial); | 
|  | 2748 | return status; | 
|  | 2749 | } | 
|  | 2750 |  | 
|  | 2751 | /* set up our port private structures */ | 
|  | 2752 | for (i = 0; i < serial->num_ports; ++i) { | 
| Eric Sesterhenn | 80b6ca4 | 2006-02-27 21:29:43 +0100 | [diff] [blame] | 2753 | edge_port = kzalloc(sizeof(struct edgeport_port), GFP_KERNEL); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2754 | if (edge_port == NULL) { | 
|  | 2755 | dev_err(&serial->dev->dev, "%s - Out of memory\n", __FUNCTION__); | 
|  | 2756 | goto cleanup; | 
|  | 2757 | } | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2758 | spin_lock_init(&edge_port->ep_lock); | 
|  | 2759 | edge_port->ep_out_buf = edge_buf_alloc(EDGE_OUT_BUF_SIZE); | 
|  | 2760 | if (edge_port->ep_out_buf == NULL) { | 
|  | 2761 | dev_err(&serial->dev->dev, "%s - Out of memory\n", __FUNCTION__); | 
|  | 2762 | kfree(edge_port); | 
|  | 2763 | goto cleanup; | 
|  | 2764 | } | 
|  | 2765 | edge_port->port = serial->port[i]; | 
|  | 2766 | edge_port->edge_serial = edge_serial; | 
|  | 2767 | usb_set_serial_port_data(serial->port[i], edge_port); | 
| Martin K. Petersen | fc4cbd7 | 2007-05-22 15:57:04 -0400 | [diff] [blame] | 2768 | edge_port->bUartMode = default_uart_mode; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2769 | } | 
|  | 2770 |  | 
|  | 2771 | return 0; | 
|  | 2772 |  | 
|  | 2773 | cleanup: | 
|  | 2774 | for (--i; i>=0; --i) { | 
|  | 2775 | edge_port = usb_get_serial_port_data(serial->port[i]); | 
|  | 2776 | edge_buf_free(edge_port->ep_out_buf); | 
|  | 2777 | kfree(edge_port); | 
|  | 2778 | usb_set_serial_port_data(serial->port[i], NULL); | 
|  | 2779 | } | 
|  | 2780 | kfree (edge_serial); | 
|  | 2781 | usb_set_serial_data(serial, NULL); | 
|  | 2782 | return -ENOMEM; | 
|  | 2783 | } | 
|  | 2784 |  | 
|  | 2785 | static void edge_shutdown (struct usb_serial *serial) | 
|  | 2786 | { | 
|  | 2787 | int i; | 
|  | 2788 | struct edgeport_port *edge_port; | 
|  | 2789 |  | 
|  | 2790 | dbg ("%s", __FUNCTION__); | 
|  | 2791 |  | 
| Jesper Juhl | 0d46c00 | 2007-07-16 22:17:25 +0200 | [diff] [blame] | 2792 | for (i = 0; i < serial->num_ports; ++i) { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2793 | edge_port = usb_get_serial_port_data(serial->port[i]); | 
| Martin K. Petersen | fc4cbd7 | 2007-05-22 15:57:04 -0400 | [diff] [blame] | 2794 | edge_remove_sysfs_attrs(edge_port->port); | 
| Jesper Juhl | 0d46c00 | 2007-07-16 22:17:25 +0200 | [diff] [blame] | 2795 | edge_buf_free(edge_port->ep_out_buf); | 
|  | 2796 | kfree(edge_port); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2797 | usb_set_serial_port_data(serial->port[i], NULL); | 
|  | 2798 | } | 
| Jesper Juhl | 0d46c00 | 2007-07-16 22:17:25 +0200 | [diff] [blame] | 2799 | kfree(usb_get_serial_data(serial)); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2800 | usb_set_serial_data(serial, NULL); | 
|  | 2801 | } | 
|  | 2802 |  | 
|  | 2803 |  | 
| Martin K. Petersen | fc4cbd7 | 2007-05-22 15:57:04 -0400 | [diff] [blame] | 2804 | /* Sysfs Attributes */ | 
|  | 2805 |  | 
|  | 2806 | static ssize_t show_uart_mode(struct device *dev, | 
|  | 2807 | struct device_attribute *attr, char *buf) | 
|  | 2808 | { | 
|  | 2809 | struct usb_serial_port *port = to_usb_serial_port(dev); | 
|  | 2810 | struct edgeport_port *edge_port = usb_get_serial_port_data(port); | 
|  | 2811 |  | 
|  | 2812 | return sprintf(buf, "%d\n", edge_port->bUartMode); | 
|  | 2813 | } | 
|  | 2814 |  | 
|  | 2815 | static ssize_t store_uart_mode(struct device *dev, | 
|  | 2816 | struct device_attribute *attr, const char *valbuf, size_t count) | 
|  | 2817 | { | 
|  | 2818 | struct usb_serial_port *port = to_usb_serial_port(dev); | 
|  | 2819 | struct edgeport_port *edge_port = usb_get_serial_port_data(port); | 
|  | 2820 | unsigned int v = simple_strtoul(valbuf, NULL, 0); | 
|  | 2821 |  | 
|  | 2822 | dbg("%s: setting uart_mode = %d", __FUNCTION__, v); | 
|  | 2823 |  | 
|  | 2824 | if (v < 256) | 
|  | 2825 | edge_port->bUartMode = v; | 
|  | 2826 | else | 
|  | 2827 | dev_err(dev, "%s - uart_mode %d is invalid\n", __FUNCTION__, v); | 
|  | 2828 |  | 
|  | 2829 | return count; | 
|  | 2830 | } | 
|  | 2831 |  | 
|  | 2832 | static DEVICE_ATTR(uart_mode, S_IWUSR | S_IRUGO, show_uart_mode, store_uart_mode); | 
|  | 2833 |  | 
|  | 2834 | static int edge_create_sysfs_attrs(struct usb_serial_port *port) | 
|  | 2835 | { | 
|  | 2836 | return device_create_file(&port->dev, &dev_attr_uart_mode); | 
|  | 2837 | } | 
|  | 2838 |  | 
|  | 2839 | static int edge_remove_sysfs_attrs(struct usb_serial_port *port) | 
|  | 2840 | { | 
|  | 2841 | device_remove_file(&port->dev, &dev_attr_uart_mode); | 
|  | 2842 | return 0; | 
|  | 2843 | } | 
|  | 2844 |  | 
|  | 2845 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2846 | /* Circular Buffer */ | 
|  | 2847 |  | 
|  | 2848 | /* | 
|  | 2849 | * edge_buf_alloc | 
|  | 2850 | * | 
|  | 2851 | * Allocate a circular buffer and all associated memory. | 
|  | 2852 | */ | 
|  | 2853 |  | 
|  | 2854 | static struct edge_buf *edge_buf_alloc(unsigned int size) | 
|  | 2855 | { | 
|  | 2856 | struct edge_buf *eb; | 
|  | 2857 |  | 
|  | 2858 |  | 
|  | 2859 | if (size == 0) | 
|  | 2860 | return NULL; | 
|  | 2861 |  | 
| Robert P. J. Day | 5cbded5 | 2006-12-13 00:35:56 -0800 | [diff] [blame] | 2862 | eb = kmalloc(sizeof(struct edge_buf), GFP_KERNEL); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2863 | if (eb == NULL) | 
|  | 2864 | return NULL; | 
|  | 2865 |  | 
|  | 2866 | eb->buf_buf = kmalloc(size, GFP_KERNEL); | 
|  | 2867 | if (eb->buf_buf == NULL) { | 
|  | 2868 | kfree(eb); | 
|  | 2869 | return NULL; | 
|  | 2870 | } | 
|  | 2871 |  | 
|  | 2872 | eb->buf_size = size; | 
|  | 2873 | eb->buf_get = eb->buf_put = eb->buf_buf; | 
|  | 2874 |  | 
|  | 2875 | return eb; | 
|  | 2876 | } | 
|  | 2877 |  | 
|  | 2878 |  | 
|  | 2879 | /* | 
|  | 2880 | * edge_buf_free | 
|  | 2881 | * | 
|  | 2882 | * Free the buffer and all associated memory. | 
|  | 2883 | */ | 
|  | 2884 |  | 
| Adrian Bunk | 3d48586 | 2005-11-20 23:56:11 +0100 | [diff] [blame] | 2885 | static void edge_buf_free(struct edge_buf *eb) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2886 | { | 
| Jesper Juhl | 1bc3c9e | 2005-04-18 17:39:34 -0700 | [diff] [blame] | 2887 | if (eb) { | 
|  | 2888 | kfree(eb->buf_buf); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2889 | kfree(eb); | 
|  | 2890 | } | 
|  | 2891 | } | 
|  | 2892 |  | 
|  | 2893 |  | 
|  | 2894 | /* | 
|  | 2895 | * edge_buf_clear | 
|  | 2896 | * | 
|  | 2897 | * Clear out all data in the circular buffer. | 
|  | 2898 | */ | 
|  | 2899 |  | 
|  | 2900 | static void edge_buf_clear(struct edge_buf *eb) | 
|  | 2901 | { | 
|  | 2902 | if (eb != NULL) | 
|  | 2903 | eb->buf_get = eb->buf_put; | 
|  | 2904 | /* equivalent to a get of all data available */ | 
|  | 2905 | } | 
|  | 2906 |  | 
|  | 2907 |  | 
|  | 2908 | /* | 
|  | 2909 | * edge_buf_data_avail | 
|  | 2910 | * | 
|  | 2911 | * Return the number of bytes of data available in the circular | 
|  | 2912 | * buffer. | 
|  | 2913 | */ | 
|  | 2914 |  | 
|  | 2915 | static unsigned int edge_buf_data_avail(struct edge_buf *eb) | 
|  | 2916 | { | 
|  | 2917 | if (eb != NULL) | 
|  | 2918 | return ((eb->buf_size + eb->buf_put - eb->buf_get) % eb->buf_size); | 
|  | 2919 | else | 
|  | 2920 | return 0; | 
|  | 2921 | } | 
|  | 2922 |  | 
|  | 2923 |  | 
|  | 2924 | /* | 
|  | 2925 | * edge_buf_space_avail | 
|  | 2926 | * | 
|  | 2927 | * Return the number of bytes of space available in the circular | 
|  | 2928 | * buffer. | 
|  | 2929 | */ | 
|  | 2930 |  | 
|  | 2931 | static unsigned int edge_buf_space_avail(struct edge_buf *eb) | 
|  | 2932 | { | 
|  | 2933 | if (eb != NULL) | 
|  | 2934 | return ((eb->buf_size + eb->buf_get - eb->buf_put - 1) % eb->buf_size); | 
|  | 2935 | else | 
|  | 2936 | return 0; | 
|  | 2937 | } | 
|  | 2938 |  | 
|  | 2939 |  | 
|  | 2940 | /* | 
|  | 2941 | * edge_buf_put | 
|  | 2942 | * | 
|  | 2943 | * Copy data data from a user buffer and put it into the circular buffer. | 
|  | 2944 | * Restrict to the amount of space available. | 
|  | 2945 | * | 
|  | 2946 | * Return the number of bytes copied. | 
|  | 2947 | */ | 
|  | 2948 |  | 
|  | 2949 | static unsigned int edge_buf_put(struct edge_buf *eb, const char *buf, | 
|  | 2950 | unsigned int count) | 
|  | 2951 | { | 
|  | 2952 | unsigned int len; | 
|  | 2953 |  | 
|  | 2954 |  | 
|  | 2955 | if (eb == NULL) | 
|  | 2956 | return 0; | 
|  | 2957 |  | 
|  | 2958 | len  = edge_buf_space_avail(eb); | 
|  | 2959 | if (count > len) | 
|  | 2960 | count = len; | 
|  | 2961 |  | 
|  | 2962 | if (count == 0) | 
|  | 2963 | return 0; | 
|  | 2964 |  | 
|  | 2965 | len = eb->buf_buf + eb->buf_size - eb->buf_put; | 
|  | 2966 | if (count > len) { | 
|  | 2967 | memcpy(eb->buf_put, buf, len); | 
|  | 2968 | memcpy(eb->buf_buf, buf+len, count - len); | 
|  | 2969 | eb->buf_put = eb->buf_buf + count - len; | 
|  | 2970 | } else { | 
|  | 2971 | memcpy(eb->buf_put, buf, count); | 
|  | 2972 | if (count < len) | 
|  | 2973 | eb->buf_put += count; | 
|  | 2974 | else /* count == len */ | 
|  | 2975 | eb->buf_put = eb->buf_buf; | 
|  | 2976 | } | 
|  | 2977 |  | 
|  | 2978 | return count; | 
|  | 2979 | } | 
|  | 2980 |  | 
|  | 2981 |  | 
|  | 2982 | /* | 
|  | 2983 | * edge_buf_get | 
|  | 2984 | * | 
|  | 2985 | * Get data from the circular buffer and copy to the given buffer. | 
|  | 2986 | * Restrict to the amount of data available. | 
|  | 2987 | * | 
|  | 2988 | * Return the number of bytes copied. | 
|  | 2989 | */ | 
|  | 2990 |  | 
|  | 2991 | static unsigned int edge_buf_get(struct edge_buf *eb, char *buf, | 
|  | 2992 | unsigned int count) | 
|  | 2993 | { | 
|  | 2994 | unsigned int len; | 
|  | 2995 |  | 
|  | 2996 |  | 
|  | 2997 | if (eb == NULL) | 
|  | 2998 | return 0; | 
|  | 2999 |  | 
|  | 3000 | len = edge_buf_data_avail(eb); | 
|  | 3001 | if (count > len) | 
|  | 3002 | count = len; | 
|  | 3003 |  | 
|  | 3004 | if (count == 0) | 
|  | 3005 | return 0; | 
|  | 3006 |  | 
|  | 3007 | len = eb->buf_buf + eb->buf_size - eb->buf_get; | 
|  | 3008 | if (count > len) { | 
|  | 3009 | memcpy(buf, eb->buf_get, len); | 
|  | 3010 | memcpy(buf+len, eb->buf_buf, count - len); | 
|  | 3011 | eb->buf_get = eb->buf_buf + count - len; | 
|  | 3012 | } else { | 
|  | 3013 | memcpy(buf, eb->buf_get, count); | 
|  | 3014 | if (count < len) | 
|  | 3015 | eb->buf_get += count; | 
|  | 3016 | else /* count == len */ | 
|  | 3017 | eb->buf_get = eb->buf_buf; | 
|  | 3018 | } | 
|  | 3019 |  | 
|  | 3020 | return count; | 
|  | 3021 | } | 
|  | 3022 |  | 
|  | 3023 |  | 
| Greg Kroah-Hartman | ea65370 | 2005-06-20 21:15:16 -0700 | [diff] [blame] | 3024 | static struct usb_serial_driver edgeport_1port_device = { | 
| Greg Kroah-Hartman | 18fcac3 | 2005-06-20 21:15:16 -0700 | [diff] [blame] | 3025 | .driver = { | 
| Greg Kroah-Hartman | 269bda1 | 2005-06-20 21:15:16 -0700 | [diff] [blame] | 3026 | .owner		= THIS_MODULE, | 
|  | 3027 | .name		= "edgeport_ti_1", | 
| Greg Kroah-Hartman | 18fcac3 | 2005-06-20 21:15:16 -0700 | [diff] [blame] | 3028 | }, | 
| Greg Kroah-Hartman | 269bda1 | 2005-06-20 21:15:16 -0700 | [diff] [blame] | 3029 | .description		= "Edgeport TI 1 port adapter", | 
| Johannes Hölzl | d9b1b78 | 2006-12-17 21:50:24 +0100 | [diff] [blame] | 3030 | .usb_driver		= &io_driver, | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3031 | .id_table		= edgeport_1port_id_table, | 
|  | 3032 | .num_interrupt_in	= 1, | 
|  | 3033 | .num_bulk_in		= 1, | 
|  | 3034 | .num_bulk_out		= 1, | 
|  | 3035 | .num_ports		= 1, | 
|  | 3036 | .open			= edge_open, | 
|  | 3037 | .close			= edge_close, | 
|  | 3038 | .throttle		= edge_throttle, | 
|  | 3039 | .unthrottle		= edge_unthrottle, | 
|  | 3040 | .attach			= edge_startup, | 
|  | 3041 | .shutdown		= edge_shutdown, | 
| Martin K. Petersen | fc4cbd7 | 2007-05-22 15:57:04 -0400 | [diff] [blame] | 3042 | .port_probe		= edge_create_sysfs_attrs, | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3043 | .ioctl			= edge_ioctl, | 
|  | 3044 | .set_termios		= edge_set_termios, | 
|  | 3045 | .tiocmget		= edge_tiocmget, | 
|  | 3046 | .tiocmset		= edge_tiocmset, | 
|  | 3047 | .write			= edge_write, | 
|  | 3048 | .write_room		= edge_write_room, | 
|  | 3049 | .chars_in_buffer	= edge_chars_in_buffer, | 
|  | 3050 | .break_ctl		= edge_break, | 
|  | 3051 | .read_int_callback	= edge_interrupt_callback, | 
|  | 3052 | .read_bulk_callback	= edge_bulk_in_callback, | 
|  | 3053 | .write_bulk_callback	= edge_bulk_out_callback, | 
|  | 3054 | }; | 
|  | 3055 |  | 
| Greg Kroah-Hartman | ea65370 | 2005-06-20 21:15:16 -0700 | [diff] [blame] | 3056 | static struct usb_serial_driver edgeport_2port_device = { | 
| Greg Kroah-Hartman | 18fcac3 | 2005-06-20 21:15:16 -0700 | [diff] [blame] | 3057 | .driver = { | 
| Greg Kroah-Hartman | 269bda1 | 2005-06-20 21:15:16 -0700 | [diff] [blame] | 3058 | .owner		= THIS_MODULE, | 
|  | 3059 | .name		= "edgeport_ti_2", | 
| Greg Kroah-Hartman | 18fcac3 | 2005-06-20 21:15:16 -0700 | [diff] [blame] | 3060 | }, | 
| Greg Kroah-Hartman | 269bda1 | 2005-06-20 21:15:16 -0700 | [diff] [blame] | 3061 | .description		= "Edgeport TI 2 port adapter", | 
| Johannes Hölzl | d9b1b78 | 2006-12-17 21:50:24 +0100 | [diff] [blame] | 3062 | .usb_driver		= &io_driver, | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3063 | .id_table		= edgeport_2port_id_table, | 
|  | 3064 | .num_interrupt_in	= 1, | 
|  | 3065 | .num_bulk_in		= 2, | 
|  | 3066 | .num_bulk_out		= 2, | 
|  | 3067 | .num_ports		= 2, | 
|  | 3068 | .open			= edge_open, | 
|  | 3069 | .close			= edge_close, | 
|  | 3070 | .throttle		= edge_throttle, | 
|  | 3071 | .unthrottle		= edge_unthrottle, | 
|  | 3072 | .attach			= edge_startup, | 
|  | 3073 | .shutdown		= edge_shutdown, | 
| Martin K. Petersen | fc4cbd7 | 2007-05-22 15:57:04 -0400 | [diff] [blame] | 3074 | .port_probe		= edge_create_sysfs_attrs, | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3075 | .ioctl			= edge_ioctl, | 
|  | 3076 | .set_termios		= edge_set_termios, | 
|  | 3077 | .tiocmget		= edge_tiocmget, | 
|  | 3078 | .tiocmset		= edge_tiocmset, | 
|  | 3079 | .write			= edge_write, | 
|  | 3080 | .write_room		= edge_write_room, | 
|  | 3081 | .chars_in_buffer	= edge_chars_in_buffer, | 
|  | 3082 | .break_ctl		= edge_break, | 
|  | 3083 | .read_int_callback	= edge_interrupt_callback, | 
|  | 3084 | .read_bulk_callback	= edge_bulk_in_callback, | 
|  | 3085 | .write_bulk_callback	= edge_bulk_out_callback, | 
|  | 3086 | }; | 
|  | 3087 |  | 
|  | 3088 |  | 
|  | 3089 | static int __init edgeport_init(void) | 
|  | 3090 | { | 
|  | 3091 | int retval; | 
|  | 3092 | retval = usb_serial_register(&edgeport_1port_device); | 
|  | 3093 | if (retval) | 
|  | 3094 | goto failed_1port_device_register; | 
|  | 3095 | retval = usb_serial_register(&edgeport_2port_device); | 
|  | 3096 | if (retval) | 
|  | 3097 | goto failed_2port_device_register; | 
|  | 3098 | retval = usb_register(&io_driver); | 
|  | 3099 | if (retval) | 
|  | 3100 | goto failed_usb_register; | 
|  | 3101 | info(DRIVER_DESC " " DRIVER_VERSION); | 
|  | 3102 | return 0; | 
|  | 3103 | failed_usb_register: | 
|  | 3104 | usb_serial_deregister(&edgeport_2port_device); | 
|  | 3105 | failed_2port_device_register: | 
|  | 3106 | usb_serial_deregister(&edgeport_1port_device); | 
|  | 3107 | failed_1port_device_register: | 
|  | 3108 | return retval; | 
|  | 3109 | } | 
|  | 3110 |  | 
|  | 3111 | static void __exit edgeport_exit (void) | 
|  | 3112 | { | 
|  | 3113 | usb_deregister (&io_driver); | 
|  | 3114 | usb_serial_deregister (&edgeport_1port_device); | 
|  | 3115 | usb_serial_deregister (&edgeport_2port_device); | 
|  | 3116 | } | 
|  | 3117 |  | 
|  | 3118 | module_init(edgeport_init); | 
|  | 3119 | module_exit(edgeport_exit); | 
|  | 3120 |  | 
|  | 3121 | /* Module information */ | 
|  | 3122 | MODULE_AUTHOR(DRIVER_AUTHOR); | 
|  | 3123 | MODULE_DESCRIPTION(DRIVER_DESC); | 
|  | 3124 | MODULE_LICENSE("GPL"); | 
|  | 3125 |  | 
|  | 3126 | module_param(debug, bool, S_IRUGO | S_IWUSR); | 
|  | 3127 | MODULE_PARM_DESC(debug, "Debug enabled or not"); | 
|  | 3128 |  | 
|  | 3129 | module_param(low_latency, bool, S_IRUGO | S_IWUSR); | 
|  | 3130 | MODULE_PARM_DESC(low_latency, "Low latency enabled or not"); | 
|  | 3131 |  | 
|  | 3132 | module_param(closing_wait, int, S_IRUGO | S_IWUSR); | 
|  | 3133 | MODULE_PARM_DESC(closing_wait, "Maximum wait for data to drain, in .01 secs"); | 
|  | 3134 |  | 
|  | 3135 | module_param(ignore_cpu_rev, bool, S_IRUGO | S_IWUSR); | 
|  | 3136 | MODULE_PARM_DESC(ignore_cpu_rev, "Ignore the cpu revision when connecting to a device"); | 
|  | 3137 |  | 
| Martin K. Petersen | fc4cbd7 | 2007-05-22 15:57:04 -0400 | [diff] [blame] | 3138 | module_param(default_uart_mode, int, S_IRUGO | S_IWUSR); | 
|  | 3139 | MODULE_PARM_DESC(default_uart_mode, "Default uart_mode, 0=RS232, ..."); | 
|  | 3140 |  |