80b6ca4832
Signed-off-by: Eric Sesterhenn <snakebyte@gmx.de> Signed-off-by: Greg Kroah-Hartman <gregkh@suse.de>
3086 lines
83 KiB
C
3086 lines
83 KiB
C
/*
|
|
* Edgeport USB Serial Converter driver
|
|
*
|
|
* Copyright (C) 2000-2002 Inside Out Networks, All rights reserved.
|
|
* Copyright (C) 2001-2002 Greg Kroah-Hartman <greg@kroah.com>
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify
|
|
* it under the terms of the GNU General Public License as published by
|
|
* the Free Software Foundation; either version 2 of the License, or
|
|
* (at your option) any later version.
|
|
*
|
|
* Supports the following devices:
|
|
* EP/1 EP/2 EP/4 EP/21 EP/22 EP/221 EP/42 EP/421 WATCHPORT
|
|
*
|
|
* For questions or problems with this driver, contact Inside Out
|
|
* Networks technical support, or Peter Berger <pberger@brimson.com>,
|
|
* or Al Borchers <alborchers@steinerpoint.com>.
|
|
*
|
|
* Version history:
|
|
*
|
|
* July 11, 2002 Removed 4 port device structure since all TI UMP
|
|
* chips have only 2 ports
|
|
* David Iacovelli (davidi@ionetworks.com)
|
|
*
|
|
*/
|
|
|
|
#include <linux/config.h>
|
|
#include <linux/kernel.h>
|
|
#include <linux/jiffies.h>
|
|
#include <linux/errno.h>
|
|
#include <linux/init.h>
|
|
#include <linux/slab.h>
|
|
#include <linux/tty.h>
|
|
#include <linux/tty_driver.h>
|
|
#include <linux/tty_flip.h>
|
|
#include <linux/module.h>
|
|
#include <linux/spinlock.h>
|
|
#include <linux/serial.h>
|
|
#include <linux/ioctl.h>
|
|
#include <asm/uaccess.h>
|
|
#include <asm/semaphore.h>
|
|
#include <linux/usb.h>
|
|
|
|
#include "usb-serial.h"
|
|
#include "io_16654.h"
|
|
#include "io_usbvend.h"
|
|
#include "io_ti.h"
|
|
|
|
/*
|
|
* Version Information
|
|
*/
|
|
#define DRIVER_VERSION "v0.7"
|
|
#define DRIVER_AUTHOR "Greg Kroah-Hartman <greg@kroah.com> and David Iacovelli"
|
|
#define DRIVER_DESC "Edgeport USB Serial Driver"
|
|
|
|
|
|
/* firmware image code */
|
|
#define IMAGE_VERSION_NAME PagableOperationalCodeImageVersion
|
|
#define IMAGE_ARRAY_NAME PagableOperationalCodeImage
|
|
#define IMAGE_SIZE PagableOperationalCodeSize
|
|
#include "io_fw_down3.h" /* Define array OperationalCodeImage[] */
|
|
|
|
#define EPROM_PAGE_SIZE 64
|
|
|
|
|
|
struct edgeport_uart_buf_desc {
|
|
__u32 count; // Number of bytes currently in buffer
|
|
};
|
|
|
|
/* different hardware types */
|
|
#define HARDWARE_TYPE_930 0
|
|
#define HARDWARE_TYPE_TIUMP 1
|
|
|
|
// IOCTL_PRIVATE_TI_GET_MODE Definitions
|
|
#define TI_MODE_CONFIGURING 0 // Device has not entered start device
|
|
#define TI_MODE_BOOT 1 // Staying in boot mode
|
|
#define TI_MODE_DOWNLOAD 2 // Made it to download mode
|
|
#define TI_MODE_TRANSITIONING 3 // Currently in boot mode but transitioning to download mode
|
|
|
|
/* read urb state */
|
|
#define EDGE_READ_URB_RUNNING 0
|
|
#define EDGE_READ_URB_STOPPING 1
|
|
#define EDGE_READ_URB_STOPPED 2
|
|
|
|
#define EDGE_LOW_LATENCY 1
|
|
#define EDGE_CLOSING_WAIT 4000 /* in .01 sec */
|
|
|
|
#define EDGE_OUT_BUF_SIZE 1024
|
|
|
|
|
|
/* Product information read from the Edgeport */
|
|
struct product_info
|
|
{
|
|
int TiMode; // Current TI Mode
|
|
__u8 hardware_type; // Type of hardware
|
|
} __attribute__((packed));
|
|
|
|
/* circular buffer */
|
|
struct edge_buf {
|
|
unsigned int buf_size;
|
|
char *buf_buf;
|
|
char *buf_get;
|
|
char *buf_put;
|
|
};
|
|
|
|
struct edgeport_port {
|
|
__u16 uart_base;
|
|
__u16 dma_address;
|
|
__u8 shadow_msr;
|
|
__u8 shadow_mcr;
|
|
__u8 shadow_lsr;
|
|
__u8 lsr_mask;
|
|
__u32 ump_read_timeout; /* Number of miliseconds the UMP will
|
|
wait without data before completing
|
|
a read short */
|
|
int baud_rate;
|
|
int close_pending;
|
|
int lsr_event;
|
|
struct edgeport_uart_buf_desc tx;
|
|
struct async_icount icount;
|
|
wait_queue_head_t delta_msr_wait; /* for handling sleeping while
|
|
waiting for msr change to
|
|
happen */
|
|
struct edgeport_serial *edge_serial;
|
|
struct usb_serial_port *port;
|
|
__u8 bUartMode; /* Port type, 0: RS232, etc. */
|
|
spinlock_t ep_lock;
|
|
int ep_read_urb_state;
|
|
int ep_write_urb_in_use;
|
|
struct edge_buf *ep_out_buf;
|
|
};
|
|
|
|
struct edgeport_serial {
|
|
struct product_info product_info;
|
|
u8 TI_I2C_Type; // Type of I2C in UMP
|
|
u8 TiReadI2C; // Set to TRUE if we have read the I2c in Boot Mode
|
|
struct semaphore es_sem;
|
|
int num_ports_open;
|
|
struct usb_serial *serial;
|
|
};
|
|
|
|
|
|
/* Devices that this driver supports */
|
|
static struct usb_device_id edgeport_1port_id_table [] = {
|
|
{ USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_TI_EDGEPORT_1) },
|
|
{ USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_TI_TI3410_EDGEPORT_1) },
|
|
{ USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_TI_TI3410_EDGEPORT_1I) },
|
|
{ USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_WP_PROXIMITY) },
|
|
{ USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_WP_MOTION) },
|
|
{ USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_WP_MOISTURE) },
|
|
{ USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_WP_TEMPERATURE) },
|
|
{ USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_WP_HUMIDITY) },
|
|
{ USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_WP_POWER) },
|
|
{ USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_WP_LIGHT) },
|
|
{ USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_WP_RADIATION) },
|
|
{ USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_WP_DISTANCE) },
|
|
{ USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_WP_ACCELERATION) },
|
|
{ USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_WP_PROX_DIST) },
|
|
{ USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_PLUS_PWR_HP4CD) },
|
|
{ USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_PLUS_PWR_PCI) },
|
|
{ }
|
|
};
|
|
|
|
static struct usb_device_id edgeport_2port_id_table [] = {
|
|
{ USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_TI_EDGEPORT_2) },
|
|
{ USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_TI_EDGEPORT_2C) },
|
|
{ USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_TI_EDGEPORT_2I) },
|
|
{ USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_TI_EDGEPORT_421) },
|
|
{ USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_TI_EDGEPORT_21) },
|
|
{ USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_TI_EDGEPORT_42) },
|
|
{ USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_TI_EDGEPORT_4) },
|
|
{ USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_TI_EDGEPORT_4I) },
|
|
{ USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_TI_EDGEPORT_22I) },
|
|
{ USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_TI_EDGEPORT_221C) },
|
|
{ USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_TI_EDGEPORT_22C) },
|
|
{ USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_TI_EDGEPORT_21C) },
|
|
// The 4-port shows up as two 2-port devices
|
|
{ USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_TI_EDGEPORT_4S) },
|
|
{ }
|
|
};
|
|
|
|
/* Devices that this driver supports */
|
|
static struct usb_device_id id_table_combined [] = {
|
|
{ USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_TI_EDGEPORT_1) },
|
|
{ USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_TI_TI3410_EDGEPORT_1) },
|
|
{ USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_TI_TI3410_EDGEPORT_1I) },
|
|
{ USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_WP_PROXIMITY) },
|
|
{ USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_WP_MOTION) },
|
|
{ USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_WP_MOISTURE) },
|
|
{ USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_WP_TEMPERATURE) },
|
|
{ USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_WP_HUMIDITY) },
|
|
{ USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_WP_POWER) },
|
|
{ USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_WP_LIGHT) },
|
|
{ USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_WP_RADIATION) },
|
|
{ USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_WP_DISTANCE) },
|
|
{ USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_WP_ACCELERATION) },
|
|
{ USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_WP_PROX_DIST) },
|
|
{ USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_PLUS_PWR_HP4CD) },
|
|
{ USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_PLUS_PWR_PCI) },
|
|
{ USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_TI_EDGEPORT_2) },
|
|
{ USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_TI_EDGEPORT_2C) },
|
|
{ USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_TI_EDGEPORT_2I) },
|
|
{ USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_TI_EDGEPORT_421) },
|
|
{ USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_TI_EDGEPORT_21) },
|
|
{ USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_TI_EDGEPORT_42) },
|
|
{ USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_TI_EDGEPORT_4) },
|
|
{ USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_TI_EDGEPORT_4I) },
|
|
{ USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_TI_EDGEPORT_22I) },
|
|
{ USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_TI_EDGEPORT_221C) },
|
|
{ USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_TI_EDGEPORT_22C) },
|
|
{ USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_TI_EDGEPORT_21C) },
|
|
{ USB_DEVICE(USB_VENDOR_ID_ION, ION_DEVICE_ID_TI_EDGEPORT_4S) },
|
|
{ }
|
|
};
|
|
|
|
MODULE_DEVICE_TABLE (usb, id_table_combined);
|
|
|
|
static struct usb_driver io_driver = {
|
|
.name = "io_ti",
|
|
.probe = usb_serial_probe,
|
|
.disconnect = usb_serial_disconnect,
|
|
.id_table = id_table_combined,
|
|
.no_dynamic_id = 1,
|
|
};
|
|
|
|
|
|
static struct EDGE_FIRMWARE_VERSION_INFO OperationalCodeImageVersion;
|
|
|
|
static int debug;
|
|
|
|
static int TIStayInBootMode = 0;
|
|
static int low_latency = EDGE_LOW_LATENCY;
|
|
static int closing_wait = EDGE_CLOSING_WAIT;
|
|
static int ignore_cpu_rev = 0;
|
|
|
|
|
|
static void edge_tty_recv(struct device *dev, struct tty_struct *tty, unsigned char *data, int length);
|
|
|
|
static void stop_read(struct edgeport_port *edge_port);
|
|
static int restart_read(struct edgeport_port *edge_port);
|
|
|
|
static void edge_set_termios (struct usb_serial_port *port, struct termios *old_termios);
|
|
static void edge_send(struct usb_serial_port *port);
|
|
|
|
/* circular buffer */
|
|
static struct edge_buf *edge_buf_alloc(unsigned int size);
|
|
static void edge_buf_free(struct edge_buf *eb);
|
|
static void edge_buf_clear(struct edge_buf *eb);
|
|
static unsigned int edge_buf_data_avail(struct edge_buf *eb);
|
|
static unsigned int edge_buf_space_avail(struct edge_buf *eb);
|
|
static unsigned int edge_buf_put(struct edge_buf *eb, const char *buf,
|
|
unsigned int count);
|
|
static unsigned int edge_buf_get(struct edge_buf *eb, char *buf,
|
|
unsigned int count);
|
|
|
|
|
|
static int TIReadVendorRequestSync (struct usb_device *dev,
|
|
__u8 request,
|
|
__u16 value,
|
|
__u16 index,
|
|
u8 *data,
|
|
int size)
|
|
{
|
|
int status;
|
|
|
|
status = usb_control_msg (dev,
|
|
usb_rcvctrlpipe(dev, 0),
|
|
request,
|
|
(USB_TYPE_VENDOR |
|
|
USB_RECIP_DEVICE |
|
|
USB_DIR_IN),
|
|
value,
|
|
index,
|
|
data,
|
|
size,
|
|
1000);
|
|
if (status < 0)
|
|
return status;
|
|
if (status != size) {
|
|
dbg ("%s - wanted to write %d, but only wrote %d",
|
|
__FUNCTION__, size, status);
|
|
return -ECOMM;
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
static int TISendVendorRequestSync (struct usb_device *dev,
|
|
__u8 request,
|
|
__u16 value,
|
|
__u16 index,
|
|
u8 *data,
|
|
int size)
|
|
{
|
|
int status;
|
|
|
|
status = usb_control_msg (dev,
|
|
usb_sndctrlpipe(dev, 0),
|
|
request,
|
|
(USB_TYPE_VENDOR |
|
|
USB_RECIP_DEVICE |
|
|
USB_DIR_OUT),
|
|
value,
|
|
index,
|
|
data,
|
|
size,
|
|
1000);
|
|
if (status < 0)
|
|
return status;
|
|
if (status != size) {
|
|
dbg ("%s - wanted to write %d, but only wrote %d",
|
|
__FUNCTION__, size, status);
|
|
return -ECOMM;
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
static int TIWriteCommandSync (struct usb_device *dev, __u8 command,
|
|
__u8 moduleid, __u16 value, u8 *data,
|
|
int size)
|
|
{
|
|
return TISendVendorRequestSync (dev,
|
|
command, // Request
|
|
value, // wValue
|
|
moduleid, // wIndex
|
|
data, // TransferBuffer
|
|
size); // TransferBufferLength
|
|
|
|
}
|
|
|
|
/* clear tx/rx buffers and fifo in TI UMP */
|
|
static int TIPurgeDataSync (struct usb_serial_port *port, __u16 mask)
|
|
{
|
|
int port_number = port->number - port->serial->minor;
|
|
|
|
dbg ("%s - port %d, mask %x", __FUNCTION__, port_number, mask);
|
|
|
|
return TIWriteCommandSync (port->serial->dev,
|
|
UMPC_PURGE_PORT,
|
|
(__u8)(UMPM_UART1_PORT + port_number),
|
|
mask,
|
|
NULL,
|
|
0);
|
|
}
|
|
|
|
/**
|
|
* TIReadDownloadMemory - Read edgeport memory from TI chip
|
|
* @dev: usb device pointer
|
|
* @start_address: Device CPU address at which to read
|
|
* @length: Length of above data
|
|
* @address_type: Can read both XDATA and I2C
|
|
* @buffer: pointer to input data buffer
|
|
*/
|
|
static int TIReadDownloadMemory(struct usb_device *dev, int start_address,
|
|
int length, __u8 address_type, __u8 *buffer)
|
|
{
|
|
int status = 0;
|
|
__u8 read_length;
|
|
__be16 be_start_address;
|
|
|
|
dbg ("%s - @ %x for %d", __FUNCTION__, start_address, length);
|
|
|
|
/* Read in blocks of 64 bytes
|
|
* (TI firmware can't handle more than 64 byte reads)
|
|
*/
|
|
while (length) {
|
|
if (length > 64)
|
|
read_length= 64;
|
|
else
|
|
read_length = (__u8)length;
|
|
|
|
if (read_length > 1) {
|
|
dbg ("%s - @ %x for %d", __FUNCTION__,
|
|
start_address, read_length);
|
|
}
|
|
be_start_address = cpu_to_be16 (start_address);
|
|
status = TIReadVendorRequestSync (dev,
|
|
UMPC_MEMORY_READ, // Request
|
|
(__u16)address_type, // wValue (Address type)
|
|
(__force __u16)be_start_address, // wIndex (Address to read)
|
|
buffer, // TransferBuffer
|
|
read_length); // TransferBufferLength
|
|
|
|
if (status) {
|
|
dbg ("%s - ERROR %x", __FUNCTION__, status);
|
|
return status;
|
|
}
|
|
|
|
if (read_length > 1) {
|
|
usb_serial_debug_data(debug, &dev->dev, __FUNCTION__,
|
|
read_length, buffer);
|
|
}
|
|
|
|
/* Update pointers/length */
|
|
start_address += read_length;
|
|
buffer += read_length;
|
|
length -= read_length;
|
|
}
|
|
|
|
return status;
|
|
}
|
|
|
|
static int TIReadRam (struct usb_device *dev, int start_address, int length, __u8 *buffer)
|
|
{
|
|
return TIReadDownloadMemory (dev,
|
|
start_address,
|
|
length,
|
|
DTK_ADDR_SPACE_XDATA,
|
|
buffer);
|
|
}
|
|
|
|
/* Read edgeport memory to a given block */
|
|
static int TIReadBootMemory (struct edgeport_serial *serial, int start_address, int length, __u8 * buffer)
|
|
{
|
|
int status = 0;
|
|
int i;
|
|
|
|
for (i=0; i< length; i++) {
|
|
status = TIReadVendorRequestSync (serial->serial->dev,
|
|
UMPC_MEMORY_READ, // Request
|
|
serial->TI_I2C_Type, // wValue (Address type)
|
|
(__u16)(start_address+i), // wIndex
|
|
&buffer[i], // TransferBuffer
|
|
0x01); // TransferBufferLength
|
|
if (status) {
|
|
dbg ("%s - ERROR %x", __FUNCTION__, status);
|
|
return status;
|
|
}
|
|
}
|
|
|
|
dbg ("%s - start_address = %x, length = %d", __FUNCTION__, start_address, length);
|
|
usb_serial_debug_data(debug, &serial->serial->dev->dev, __FUNCTION__, length, buffer);
|
|
|
|
serial->TiReadI2C = 1;
|
|
|
|
return status;
|
|
}
|
|
|
|
/* Write given block to TI EPROM memory */
|
|
static int TIWriteBootMemory (struct edgeport_serial *serial, int start_address, int length, __u8 *buffer)
|
|
{
|
|
int status = 0;
|
|
int i;
|
|
__u8 temp;
|
|
|
|
/* Must do a read before write */
|
|
if (!serial->TiReadI2C) {
|
|
status = TIReadBootMemory(serial, 0, 1, &temp);
|
|
if (status)
|
|
return status;
|
|
}
|
|
|
|
for (i=0; i < length; ++i) {
|
|
status = TISendVendorRequestSync (serial->serial->dev,
|
|
UMPC_MEMORY_WRITE, // Request
|
|
buffer[i], // wValue
|
|
(__u16)(i+start_address), // wIndex
|
|
NULL, // TransferBuffer
|
|
0); // TransferBufferLength
|
|
if (status)
|
|
return status;
|
|
}
|
|
|
|
dbg ("%s - start_sddr = %x, length = %d", __FUNCTION__, start_address, length);
|
|
usb_serial_debug_data(debug, &serial->serial->dev->dev, __FUNCTION__, length, buffer);
|
|
|
|
return status;
|
|
}
|
|
|
|
|
|
/* Write edgeport I2C memory to TI chip */
|
|
static int TIWriteDownloadI2C (struct edgeport_serial *serial, int start_address, int length, __u8 address_type, __u8 *buffer)
|
|
{
|
|
int status = 0;
|
|
int write_length;
|
|
__be16 be_start_address;
|
|
|
|
/* We can only send a maximum of 1 aligned byte page at a time */
|
|
|
|
/* calulate the number of bytes left in the first page */
|
|
write_length = EPROM_PAGE_SIZE - (start_address & (EPROM_PAGE_SIZE - 1));
|
|
|
|
if (write_length > length)
|
|
write_length = length;
|
|
|
|
dbg ("%s - BytesInFirstPage Addr = %x, length = %d", __FUNCTION__, start_address, write_length);
|
|
usb_serial_debug_data(debug, &serial->serial->dev->dev, __FUNCTION__, write_length, buffer);
|
|
|
|
/* Write first page */
|
|
be_start_address = cpu_to_be16 (start_address);
|
|
status = TISendVendorRequestSync (serial->serial->dev,
|
|
UMPC_MEMORY_WRITE, // Request
|
|
(__u16)address_type, // wValue
|
|
(__force __u16)be_start_address, // wIndex
|
|
buffer, // TransferBuffer
|
|
write_length);
|
|
if (status) {
|
|
dbg ("%s - ERROR %d", __FUNCTION__, status);
|
|
return status;
|
|
}
|
|
|
|
length -= write_length;
|
|
start_address += write_length;
|
|
buffer += write_length;
|
|
|
|
/* We should be aligned now -- can write max page size bytes at a time */
|
|
while (length) {
|
|
if (length > EPROM_PAGE_SIZE)
|
|
write_length = EPROM_PAGE_SIZE;
|
|
else
|
|
write_length = length;
|
|
|
|
dbg ("%s - Page Write Addr = %x, length = %d", __FUNCTION__, start_address, write_length);
|
|
usb_serial_debug_data(debug, &serial->serial->dev->dev, __FUNCTION__, write_length, buffer);
|
|
|
|
/* Write next page */
|
|
be_start_address = cpu_to_be16 (start_address);
|
|
status = TISendVendorRequestSync (serial->serial->dev,
|
|
UMPC_MEMORY_WRITE, // Request
|
|
(__u16)address_type, // wValue
|
|
(__force __u16)be_start_address, // wIndex
|
|
buffer, // TransferBuffer
|
|
write_length); // TransferBufferLength
|
|
if (status) {
|
|
dev_err (&serial->serial->dev->dev, "%s - ERROR %d\n", __FUNCTION__, status);
|
|
return status;
|
|
}
|
|
|
|
length -= write_length;
|
|
start_address += write_length;
|
|
buffer += write_length;
|
|
}
|
|
return status;
|
|
}
|
|
|
|
/* Examine the UMP DMA registers and LSR
|
|
*
|
|
* Check the MSBit of the X and Y DMA byte count registers.
|
|
* A zero in this bit indicates that the TX DMA buffers are empty
|
|
* then check the TX Empty bit in the UART.
|
|
*/
|
|
static int TIIsTxActive (struct edgeport_port *port)
|
|
{
|
|
int status;
|
|
struct out_endpoint_desc_block *oedb;
|
|
__u8 *lsr;
|
|
int bytes_left = 0;
|
|
|
|
oedb = kmalloc (sizeof (* oedb), GFP_KERNEL);
|
|
if (!oedb) {
|
|
dev_err (&port->port->dev, "%s - out of memory\n", __FUNCTION__);
|
|
return -ENOMEM;
|
|
}
|
|
|
|
lsr = kmalloc (1, GFP_KERNEL); /* Sigh, that's right, just one byte,
|
|
as not all platforms can do DMA
|
|
from stack */
|
|
if (!lsr) {
|
|
kfree(oedb);
|
|
return -ENOMEM;
|
|
}
|
|
/* Read the DMA Count Registers */
|
|
status = TIReadRam (port->port->serial->dev,
|
|
port->dma_address,
|
|
sizeof( *oedb),
|
|
(void *)oedb);
|
|
|
|
if (status)
|
|
goto exit_is_tx_active;
|
|
|
|
dbg ("%s - XByteCount 0x%X", __FUNCTION__, oedb->XByteCount);
|
|
|
|
/* and the LSR */
|
|
status = TIReadRam (port->port->serial->dev,
|
|
port->uart_base + UMPMEM_OFFS_UART_LSR,
|
|
1,
|
|
lsr);
|
|
|
|
if (status)
|
|
goto exit_is_tx_active;
|
|
dbg ("%s - LSR = 0x%X", __FUNCTION__, *lsr);
|
|
|
|
/* If either buffer has data or we are transmitting then return TRUE */
|
|
if ((oedb->XByteCount & 0x80 ) != 0 )
|
|
bytes_left += 64;
|
|
|
|
if ((*lsr & UMP_UART_LSR_TX_MASK ) == 0 )
|
|
bytes_left += 1;
|
|
|
|
/* We return Not Active if we get any kind of error */
|
|
exit_is_tx_active:
|
|
dbg ("%s - return %d", __FUNCTION__, bytes_left );
|
|
|
|
kfree(lsr);
|
|
kfree(oedb);
|
|
return bytes_left;
|
|
}
|
|
|
|
static void TIChasePort(struct edgeport_port *port, unsigned long timeout, int flush)
|
|
{
|
|
int baud_rate;
|
|
struct tty_struct *tty = port->port->tty;
|
|
wait_queue_t wait;
|
|
unsigned long flags;
|
|
|
|
if (!timeout)
|
|
timeout = (HZ*EDGE_CLOSING_WAIT)/100;
|
|
|
|
/* wait for data to drain from the buffer */
|
|
spin_lock_irqsave(&port->ep_lock, flags);
|
|
init_waitqueue_entry(&wait, current);
|
|
add_wait_queue(&tty->write_wait, &wait);
|
|
for (;;) {
|
|
set_current_state(TASK_INTERRUPTIBLE);
|
|
if (edge_buf_data_avail(port->ep_out_buf) == 0
|
|
|| timeout == 0 || signal_pending(current)
|
|
|| !usb_get_intfdata(port->port->serial->interface)) /* disconnect */
|
|
break;
|
|
spin_unlock_irqrestore(&port->ep_lock, flags);
|
|
timeout = schedule_timeout(timeout);
|
|
spin_lock_irqsave(&port->ep_lock, flags);
|
|
}
|
|
set_current_state(TASK_RUNNING);
|
|
remove_wait_queue(&tty->write_wait, &wait);
|
|
if (flush)
|
|
edge_buf_clear(port->ep_out_buf);
|
|
spin_unlock_irqrestore(&port->ep_lock, flags);
|
|
|
|
/* wait for data to drain from the device */
|
|
timeout += jiffies;
|
|
while ((long)(jiffies - timeout) < 0 && !signal_pending(current)
|
|
&& usb_get_intfdata(port->port->serial->interface)) { /* not disconnected */
|
|
if (!TIIsTxActive(port))
|
|
break;
|
|
msleep(10);
|
|
}
|
|
|
|
/* disconnected */
|
|
if (!usb_get_intfdata(port->port->serial->interface))
|
|
return;
|
|
|
|
/* wait one more character time, based on baud rate */
|
|
/* (TIIsTxActive doesn't seem to wait for the last byte) */
|
|
if ((baud_rate=port->baud_rate) == 0)
|
|
baud_rate = 50;
|
|
msleep(max(1,(10000+baud_rate-1)/baud_rate));
|
|
}
|
|
|
|
static int TIChooseConfiguration (struct usb_device *dev)
|
|
{
|
|
// There may be multiple configurations on this device, in which case
|
|
// we would need to read and parse all of them to find out which one
|
|
// we want. However, we just support one config at this point,
|
|
// configuration # 1, which is Config Descriptor 0.
|
|
|
|
dbg ("%s - Number of Interfaces = %d", __FUNCTION__, dev->config->desc.bNumInterfaces);
|
|
dbg ("%s - MAX Power = %d", __FUNCTION__, dev->config->desc.bMaxPower*2);
|
|
|
|
if (dev->config->desc.bNumInterfaces != 1) {
|
|
dev_err (&dev->dev, "%s - bNumInterfaces is not 1, ERROR!\n", __FUNCTION__);
|
|
return -ENODEV;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int TIReadRom (struct edgeport_serial *serial, int start_address, int length, __u8 *buffer)
|
|
{
|
|
int status;
|
|
|
|
if (serial->product_info.TiMode == TI_MODE_DOWNLOAD) {
|
|
status = TIReadDownloadMemory (serial->serial->dev,
|
|
start_address,
|
|
length,
|
|
serial->TI_I2C_Type,
|
|
buffer);
|
|
} else {
|
|
status = TIReadBootMemory (serial,
|
|
start_address,
|
|
length,
|
|
buffer);
|
|
}
|
|
|
|
return status;
|
|
}
|
|
|
|
static int TIWriteRom (struct edgeport_serial *serial, int start_address, int length, __u8 *buffer)
|
|
{
|
|
if (serial->product_info.TiMode == TI_MODE_BOOT)
|
|
return TIWriteBootMemory (serial,
|
|
start_address,
|
|
length,
|
|
buffer);
|
|
|
|
if (serial->product_info.TiMode == TI_MODE_DOWNLOAD)
|
|
return TIWriteDownloadI2C (serial,
|
|
start_address,
|
|
length,
|
|
serial->TI_I2C_Type,
|
|
buffer);
|
|
|
|
return -EINVAL;
|
|
}
|
|
|
|
|
|
|
|
/* Read a descriptor header from I2C based on type */
|
|
static int TIGetDescriptorAddress (struct edgeport_serial *serial, int desc_type, struct ti_i2c_desc *rom_desc)
|
|
{
|
|
int start_address;
|
|
int status;
|
|
|
|
/* Search for requested descriptor in I2C */
|
|
start_address = 2;
|
|
do {
|
|
status = TIReadRom (serial,
|
|
start_address,
|
|
sizeof(struct ti_i2c_desc),
|
|
(__u8 *)rom_desc );
|
|
if (status)
|
|
return 0;
|
|
|
|
if (rom_desc->Type == desc_type)
|
|
return start_address;
|
|
|
|
start_address = start_address + sizeof(struct ti_i2c_desc) + rom_desc->Size;
|
|
|
|
} while ((start_address < TI_MAX_I2C_SIZE) && rom_desc->Type);
|
|
|
|
return 0;
|
|
}
|
|
|
|
/* Validate descriptor checksum */
|
|
static int ValidChecksum(struct ti_i2c_desc *rom_desc, __u8 *buffer)
|
|
{
|
|
__u16 i;
|
|
__u8 cs = 0;
|
|
|
|
for (i=0; i < rom_desc->Size; i++) {
|
|
cs = (__u8)(cs + buffer[i]);
|
|
}
|
|
if (cs != rom_desc->CheckSum) {
|
|
dbg ("%s - Mismatch %x - %x", __FUNCTION__, rom_desc->CheckSum, cs);
|
|
return -EINVAL;
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
/* Make sure that the I2C image is good */
|
|
static int TiValidateI2cImage (struct edgeport_serial *serial)
|
|
{
|
|
struct device *dev = &serial->serial->dev->dev;
|
|
int status = 0;
|
|
struct ti_i2c_desc *rom_desc;
|
|
int start_address = 2;
|
|
__u8 *buffer;
|
|
__u16 ttype;
|
|
|
|
rom_desc = kmalloc (sizeof (*rom_desc), GFP_KERNEL);
|
|
if (!rom_desc) {
|
|
dev_err (dev, "%s - out of memory\n", __FUNCTION__);
|
|
return -ENOMEM;
|
|
}
|
|
buffer = kmalloc (TI_MAX_I2C_SIZE, GFP_KERNEL);
|
|
if (!buffer) {
|
|
dev_err (dev, "%s - out of memory when allocating buffer\n", __FUNCTION__);
|
|
kfree (rom_desc);
|
|
return -ENOMEM;
|
|
}
|
|
|
|
// Read the first byte (Signature0) must be 0x52 or 0x10
|
|
status = TIReadRom (serial, 0, 1, buffer);
|
|
if (status)
|
|
goto ExitTiValidateI2cImage;
|
|
|
|
if (*buffer != UMP5152 && *buffer != UMP3410) {
|
|
dev_err (dev, "%s - invalid buffer signature\n", __FUNCTION__);
|
|
status = -ENODEV;
|
|
goto ExitTiValidateI2cImage;
|
|
}
|
|
|
|
do {
|
|
// Validate the I2C
|
|
status = TIReadRom (serial,
|
|
start_address,
|
|
sizeof(struct ti_i2c_desc),
|
|
(__u8 *)rom_desc);
|
|
if (status)
|
|
break;
|
|
|
|
if ((start_address + sizeof(struct ti_i2c_desc) + rom_desc->Size) > TI_MAX_I2C_SIZE) {
|
|
status = -ENODEV;
|
|
dbg ("%s - structure too big, erroring out.", __FUNCTION__);
|
|
break;
|
|
}
|
|
|
|
dbg ("%s Type = 0x%x", __FUNCTION__, rom_desc->Type);
|
|
|
|
// Skip type 2 record
|
|
ttype = rom_desc->Type & 0x0f;
|
|
if ( ttype != I2C_DESC_TYPE_FIRMWARE_BASIC
|
|
&& ttype != I2C_DESC_TYPE_FIRMWARE_AUTO ) {
|
|
// Read the descriptor data
|
|
status = TIReadRom(serial,
|
|
start_address+sizeof(struct ti_i2c_desc),
|
|
rom_desc->Size,
|
|
buffer);
|
|
if (status)
|
|
break;
|
|
|
|
status = ValidChecksum(rom_desc, buffer);
|
|
if (status)
|
|
break;
|
|
}
|
|
start_address = start_address + sizeof(struct ti_i2c_desc) + rom_desc->Size;
|
|
|
|
} while ((rom_desc->Type != I2C_DESC_TYPE_ION) && (start_address < TI_MAX_I2C_SIZE));
|
|
|
|
if ((rom_desc->Type != I2C_DESC_TYPE_ION) || (start_address > TI_MAX_I2C_SIZE))
|
|
status = -ENODEV;
|
|
|
|
ExitTiValidateI2cImage:
|
|
kfree (buffer);
|
|
kfree (rom_desc);
|
|
return status;
|
|
}
|
|
|
|
static int TIReadManufDescriptor (struct edgeport_serial *serial, __u8 *buffer)
|
|
{
|
|
int status;
|
|
int start_address;
|
|
struct ti_i2c_desc *rom_desc;
|
|
struct edge_ti_manuf_descriptor *desc;
|
|
|
|
rom_desc = kmalloc (sizeof (*rom_desc), GFP_KERNEL);
|
|
if (!rom_desc) {
|
|
dev_err (&serial->serial->dev->dev, "%s - out of memory\n", __FUNCTION__);
|
|
return -ENOMEM;
|
|
}
|
|
start_address = TIGetDescriptorAddress (serial, I2C_DESC_TYPE_ION, rom_desc);
|
|
|
|
if (!start_address) {
|
|
dbg ("%s - Edge Descriptor not found in I2C", __FUNCTION__);
|
|
status = -ENODEV;
|
|
goto exit;
|
|
}
|
|
|
|
// Read the descriptor data
|
|
status = TIReadRom (serial,
|
|
start_address+sizeof(struct ti_i2c_desc),
|
|
rom_desc->Size,
|
|
buffer);
|
|
if (status)
|
|
goto exit;
|
|
|
|
status = ValidChecksum(rom_desc, buffer);
|
|
|
|
desc = (struct edge_ti_manuf_descriptor *)buffer;
|
|
dbg ( "%s - IonConfig 0x%x", __FUNCTION__, desc->IonConfig );
|
|
dbg ( "%s - Version %d", __FUNCTION__, desc->Version );
|
|
dbg ( "%s - Cpu/Board 0x%x", __FUNCTION__, desc->CpuRev_BoardRev );
|
|
dbg ( "%s - NumPorts %d", __FUNCTION__, desc->NumPorts );
|
|
dbg ( "%s - NumVirtualPorts %d", __FUNCTION__, desc->NumVirtualPorts );
|
|
dbg ( "%s - TotalPorts %d", __FUNCTION__, desc->TotalPorts );
|
|
|
|
exit:
|
|
kfree (rom_desc);
|
|
return status;
|
|
}
|
|
|
|
/* Build firmware header used for firmware update */
|
|
static int BuildI2CFirmwareHeader (__u8 *header, struct device *dev)
|
|
{
|
|
__u8 *buffer;
|
|
int buffer_size;
|
|
int i;
|
|
__u8 cs = 0;
|
|
struct ti_i2c_desc *i2c_header;
|
|
struct ti_i2c_image_header *img_header;
|
|
struct ti_i2c_firmware_rec *firmware_rec;
|
|
|
|
// In order to update the I2C firmware we must change the type 2 record to type 0xF2.
|
|
// This will force the UMP to come up in Boot Mode. Then while in boot mode, the driver
|
|
// will download the latest firmware (padded to 15.5k) into the UMP ram.
|
|
// And finally when the device comes back up in download mode the driver will cause
|
|
// the new firmware to be copied from the UMP Ram to I2C and the firmware will update
|
|
// the record type from 0xf2 to 0x02.
|
|
|
|
// Allocate a 15.5k buffer + 2 bytes for version number (Firmware Record)
|
|
buffer_size = (((1024 * 16) - 512 )+ sizeof(struct ti_i2c_firmware_rec));
|
|
|
|
buffer = kmalloc (buffer_size, GFP_KERNEL);
|
|
if (!buffer) {
|
|
dev_err (dev, "%s - out of memory\n", __FUNCTION__);
|
|
return -ENOMEM;
|
|
}
|
|
|
|
// Set entire image of 0xffs
|
|
memset (buffer, 0xff, buffer_size);
|
|
|
|
// Copy version number into firmware record
|
|
firmware_rec = (struct ti_i2c_firmware_rec *)buffer;
|
|
|
|
firmware_rec->Ver_Major = OperationalCodeImageVersion.MajorVersion;
|
|
firmware_rec->Ver_Minor = OperationalCodeImageVersion.MinorVersion;
|
|
|
|
// Pointer to fw_down memory image
|
|
img_header = (struct ti_i2c_image_header *)&PagableOperationalCodeImage[0];
|
|
|
|
memcpy (buffer + sizeof(struct ti_i2c_firmware_rec),
|
|
&PagableOperationalCodeImage[sizeof(struct ti_i2c_image_header)],
|
|
le16_to_cpu(img_header->Length));
|
|
|
|
for (i=0; i < buffer_size; i++) {
|
|
cs = (__u8)(cs + buffer[i]);
|
|
}
|
|
|
|
kfree (buffer);
|
|
|
|
// Build new header
|
|
i2c_header = (struct ti_i2c_desc *)header;
|
|
firmware_rec = (struct ti_i2c_firmware_rec*)i2c_header->Data;
|
|
|
|
i2c_header->Type = I2C_DESC_TYPE_FIRMWARE_BLANK;
|
|
i2c_header->Size = (__u16)buffer_size;
|
|
i2c_header->CheckSum = cs;
|
|
firmware_rec->Ver_Major = OperationalCodeImageVersion.MajorVersion;
|
|
firmware_rec->Ver_Minor = OperationalCodeImageVersion.MinorVersion;
|
|
|
|
return 0;
|
|
}
|
|
|
|
/* Try to figure out what type of I2c we have */
|
|
static int TIGetI2cTypeInBootMode (struct edgeport_serial *serial)
|
|
{
|
|
int status;
|
|
__u8 data;
|
|
|
|
// Try to read type 2
|
|
status = TIReadVendorRequestSync (serial->serial->dev,
|
|
UMPC_MEMORY_READ, // Request
|
|
DTK_ADDR_SPACE_I2C_TYPE_II, // wValue (Address type)
|
|
0, // wIndex
|
|
&data, // TransferBuffer
|
|
0x01); // TransferBufferLength
|
|
if (status)
|
|
dbg ("%s - read 2 status error = %d", __FUNCTION__, status);
|
|
else
|
|
dbg ("%s - read 2 data = 0x%x", __FUNCTION__, data);
|
|
if ((!status) && (data == UMP5152 || data == UMP3410)) {
|
|
dbg ("%s - ROM_TYPE_II", __FUNCTION__);
|
|
serial->TI_I2C_Type = DTK_ADDR_SPACE_I2C_TYPE_II;
|
|
return 0;
|
|
}
|
|
|
|
// Try to read type 3
|
|
status = TIReadVendorRequestSync (serial->serial->dev,
|
|
UMPC_MEMORY_READ, // Request
|
|
DTK_ADDR_SPACE_I2C_TYPE_III, // wValue (Address type)
|
|
0, // wIndex
|
|
&data, // TransferBuffer
|
|
0x01); // TransferBufferLength
|
|
if (status)
|
|
dbg ("%s - read 3 status error = %d", __FUNCTION__, status);
|
|
else
|
|
dbg ("%s - read 2 data = 0x%x", __FUNCTION__, data);
|
|
if ((!status) && (data == UMP5152 || data == UMP3410)) {
|
|
dbg ("%s - ROM_TYPE_III", __FUNCTION__);
|
|
serial->TI_I2C_Type = DTK_ADDR_SPACE_I2C_TYPE_III;
|
|
return 0;
|
|
}
|
|
|
|
dbg ("%s - Unknown", __FUNCTION__);
|
|
serial->TI_I2C_Type = DTK_ADDR_SPACE_I2C_TYPE_II;
|
|
return -ENODEV;
|
|
}
|
|
|
|
static int TISendBulkTransferSync (struct usb_serial *serial, void *buffer, int length, int *num_sent)
|
|
{
|
|
int status;
|
|
|
|
status = usb_bulk_msg (serial->dev,
|
|
usb_sndbulkpipe(serial->dev,
|
|
serial->port[0]->bulk_out_endpointAddress),
|
|
buffer,
|
|
length,
|
|
num_sent,
|
|
1000);
|
|
return status;
|
|
}
|
|
|
|
/* Download given firmware image to the device (IN BOOT MODE) */
|
|
static int TIDownloadCodeImage (struct edgeport_serial *serial, __u8 *image, int image_length)
|
|
{
|
|
int status = 0;
|
|
int pos;
|
|
int transfer;
|
|
int done;
|
|
|
|
// Transfer firmware image
|
|
for (pos = 0; pos < image_length; ) {
|
|
// Read the next buffer from file
|
|
transfer = image_length - pos;
|
|
if (transfer > EDGE_FW_BULK_MAX_PACKET_SIZE)
|
|
transfer = EDGE_FW_BULK_MAX_PACKET_SIZE;
|
|
|
|
// Transfer data
|
|
status = TISendBulkTransferSync (serial->serial, &image[pos], transfer, &done);
|
|
if (status)
|
|
break;
|
|
// Advance buffer pointer
|
|
pos += done;
|
|
}
|
|
|
|
return status;
|
|
}
|
|
|
|
// FIXME!!!
|
|
static int TIConfigureBootDevice (struct usb_device *dev)
|
|
{
|
|
return 0;
|
|
}
|
|
|
|
/**
|
|
* DownloadTIFirmware - Download run-time operating firmware to the TI5052
|
|
*
|
|
* This routine downloads the main operating code into the TI5052, using the
|
|
* boot code already burned into E2PROM or ROM.
|
|
*/
|
|
static int TIDownloadFirmware (struct edgeport_serial *serial)
|
|
{
|
|
struct device *dev = &serial->serial->dev->dev;
|
|
int status = 0;
|
|
int start_address;
|
|
struct edge_ti_manuf_descriptor *ti_manuf_desc;
|
|
struct usb_interface_descriptor *interface;
|
|
int download_cur_ver;
|
|
int download_new_ver;
|
|
|
|
/* This routine is entered by both the BOOT mode and the Download mode
|
|
* We can determine which code is running by the reading the config
|
|
* descriptor and if we have only one bulk pipe it is in boot mode
|
|
*/
|
|
serial->product_info.hardware_type = HARDWARE_TYPE_TIUMP;
|
|
|
|
/* Default to type 2 i2c */
|
|
serial->TI_I2C_Type = DTK_ADDR_SPACE_I2C_TYPE_II;
|
|
|
|
status = TIChooseConfiguration (serial->serial->dev);
|
|
if (status)
|
|
return status;
|
|
|
|
interface = &serial->serial->interface->cur_altsetting->desc;
|
|
if (!interface) {
|
|
dev_err (dev, "%s - no interface set, error!\n", __FUNCTION__);
|
|
return -ENODEV;
|
|
}
|
|
|
|
// Setup initial mode -- the default mode 0 is TI_MODE_CONFIGURING
|
|
// if we have more than one endpoint we are definitely in download mode
|
|
if (interface->bNumEndpoints > 1)
|
|
serial->product_info.TiMode = TI_MODE_DOWNLOAD;
|
|
else
|
|
// Otherwise we will remain in configuring mode
|
|
serial->product_info.TiMode = TI_MODE_CONFIGURING;
|
|
|
|
// Save Download Version Number
|
|
OperationalCodeImageVersion.MajorVersion = PagableOperationalCodeImageVersion.MajorVersion;
|
|
OperationalCodeImageVersion.MinorVersion = PagableOperationalCodeImageVersion.MinorVersion;
|
|
OperationalCodeImageVersion.BuildNumber = PagableOperationalCodeImageVersion.BuildNumber;
|
|
|
|
/********************************************************************/
|
|
/* Download Mode */
|
|
/********************************************************************/
|
|
if (serial->product_info.TiMode == TI_MODE_DOWNLOAD) {
|
|
struct ti_i2c_desc *rom_desc;
|
|
|
|
dbg ("%s - <<<<<<<<<<<<<<<RUNNING IN DOWNLOAD MODE>>>>>>>>>>", __FUNCTION__);
|
|
|
|
status = TiValidateI2cImage (serial);
|
|
if (status) {
|
|
dbg ("%s - <<<<<<<<<<<<<<<DOWNLOAD MODE -- BAD I2C >>>>>>>>>>",
|
|
__FUNCTION__);
|
|
return status;
|
|
}
|
|
|
|
/* Validate Hardware version number
|
|
* Read Manufacturing Descriptor from TI Based Edgeport
|
|
*/
|
|
ti_manuf_desc = kmalloc (sizeof (*ti_manuf_desc), GFP_KERNEL);
|
|
if (!ti_manuf_desc) {
|
|
dev_err (dev, "%s - out of memory.\n", __FUNCTION__);
|
|
return -ENOMEM;
|
|
}
|
|
status = TIReadManufDescriptor (serial, (__u8 *)ti_manuf_desc);
|
|
if (status) {
|
|
kfree (ti_manuf_desc);
|
|
return status;
|
|
}
|
|
|
|
// Check version number of ION descriptor
|
|
if (!ignore_cpu_rev && TI_GET_CPU_REVISION(ti_manuf_desc->CpuRev_BoardRev) < 2) {
|
|
dbg ( "%s - Wrong CPU Rev %d (Must be 2)", __FUNCTION__,
|
|
TI_GET_CPU_REVISION(ti_manuf_desc->CpuRev_BoardRev));
|
|
kfree (ti_manuf_desc);
|
|
return -EINVAL;
|
|
}
|
|
|
|
rom_desc = kmalloc (sizeof (*rom_desc), GFP_KERNEL);
|
|
if (!rom_desc) {
|
|
dev_err (dev, "%s - out of memory.\n", __FUNCTION__);
|
|
kfree (ti_manuf_desc);
|
|
return -ENOMEM;
|
|
}
|
|
|
|
// Search for type 2 record (firmware record)
|
|
if ((start_address = TIGetDescriptorAddress (serial, I2C_DESC_TYPE_FIRMWARE_BASIC, rom_desc)) != 0) {
|
|
struct ti_i2c_firmware_rec *firmware_version;
|
|
__u8 record;
|
|
|
|
dbg ("%s - Found Type FIRMWARE (Type 2) record", __FUNCTION__);
|
|
|
|
firmware_version = kmalloc (sizeof (*firmware_version), GFP_KERNEL);
|
|
if (!firmware_version) {
|
|
dev_err (dev, "%s - out of memory.\n", __FUNCTION__);
|
|
kfree (rom_desc);
|
|
kfree (ti_manuf_desc);
|
|
return -ENOMEM;
|
|
}
|
|
|
|
// Validate version number
|
|
// Read the descriptor data
|
|
status = TIReadRom (serial,
|
|
start_address+sizeof(struct ti_i2c_desc),
|
|
sizeof(struct ti_i2c_firmware_rec),
|
|
(__u8 *)firmware_version);
|
|
if (status) {
|
|
kfree (firmware_version);
|
|
kfree (rom_desc);
|
|
kfree (ti_manuf_desc);
|
|
return status;
|
|
}
|
|
|
|
// Check version number of download with current version in I2c
|
|
download_cur_ver = (firmware_version->Ver_Major << 8) +
|
|
(firmware_version->Ver_Minor);
|
|
download_new_ver = (OperationalCodeImageVersion.MajorVersion << 8) +
|
|
(OperationalCodeImageVersion.MinorVersion);
|
|
|
|
dbg ("%s - >>>Firmware Versions Device %d.%d Driver %d.%d",
|
|
__FUNCTION__,
|
|
firmware_version->Ver_Major,
|
|
firmware_version->Ver_Minor,
|
|
OperationalCodeImageVersion.MajorVersion,
|
|
OperationalCodeImageVersion.MinorVersion);
|
|
|
|
// Check if we have an old version in the I2C and update if necessary
|
|
if (download_cur_ver != download_new_ver) {
|
|
dbg ("%s - Update I2C Download from %d.%d to %d.%d",
|
|
__FUNCTION__,
|
|
firmware_version->Ver_Major,
|
|
firmware_version->Ver_Minor,
|
|
OperationalCodeImageVersion.MajorVersion,
|
|
OperationalCodeImageVersion.MinorVersion);
|
|
|
|
// In order to update the I2C firmware we must change the type 2 record to type 0xF2.
|
|
// This will force the UMP to come up in Boot Mode. Then while in boot mode, the driver
|
|
// will download the latest firmware (padded to 15.5k) into the UMP ram.
|
|
// And finally when the device comes back up in download mode the driver will cause
|
|
// the new firmware to be copied from the UMP Ram to I2C and the firmware will update
|
|
// the record type from 0xf2 to 0x02.
|
|
|
|
record = I2C_DESC_TYPE_FIRMWARE_BLANK;
|
|
|
|
// Change the I2C Firmware record type to 0xf2 to trigger an update
|
|
status = TIWriteRom (serial,
|
|
start_address,
|
|
sizeof(record),
|
|
&record);
|
|
if (status) {
|
|
kfree (firmware_version);
|
|
kfree (rom_desc);
|
|
kfree (ti_manuf_desc);
|
|
return status;
|
|
}
|
|
|
|
// verify the write -- must do this in order for write to
|
|
// complete before we do the hardware reset
|
|
status = TIReadRom (serial,
|
|
start_address,
|
|
sizeof(record),
|
|
&record);
|
|
|
|
if (status) {
|
|
kfree (firmware_version);
|
|
kfree (rom_desc);
|
|
kfree (ti_manuf_desc);
|
|
return status;
|
|
}
|
|
|
|
if (record != I2C_DESC_TYPE_FIRMWARE_BLANK) {
|
|
dev_err (dev, "%s - error resetting device\n", __FUNCTION__);
|
|
kfree (firmware_version);
|
|
kfree (rom_desc);
|
|
kfree (ti_manuf_desc);
|
|
return -ENODEV;
|
|
}
|
|
|
|
dbg ("%s - HARDWARE RESET", __FUNCTION__);
|
|
|
|
// Reset UMP -- Back to BOOT MODE
|
|
status = TISendVendorRequestSync (serial->serial->dev,
|
|
UMPC_HARDWARE_RESET, // Request
|
|
0, // wValue
|
|
0, // wIndex
|
|
NULL, // TransferBuffer
|
|
0); // TransferBufferLength
|
|
|
|
dbg ( "%s - HARDWARE RESET return %d", __FUNCTION__, status);
|
|
|
|
/* return an error on purpose. */
|
|
kfree (firmware_version);
|
|
kfree (rom_desc);
|
|
kfree (ti_manuf_desc);
|
|
return -ENODEV;
|
|
}
|
|
kfree (firmware_version);
|
|
}
|
|
// Search for type 0xF2 record (firmware blank record)
|
|
else if ((start_address = TIGetDescriptorAddress (serial, I2C_DESC_TYPE_FIRMWARE_BLANK, rom_desc)) != 0) {
|
|
#define HEADER_SIZE (sizeof(struct ti_i2c_desc) + sizeof(struct ti_i2c_firmware_rec))
|
|
__u8 *header;
|
|
__u8 *vheader;
|
|
|
|
header = kmalloc (HEADER_SIZE, GFP_KERNEL);
|
|
if (!header) {
|
|
dev_err (dev, "%s - out of memory.\n", __FUNCTION__);
|
|
kfree (rom_desc);
|
|
kfree (ti_manuf_desc);
|
|
return -ENOMEM;
|
|
}
|
|
|
|
vheader = kmalloc (HEADER_SIZE, GFP_KERNEL);
|
|
if (!vheader) {
|
|
dev_err (dev, "%s - out of memory.\n", __FUNCTION__);
|
|
kfree (header);
|
|
kfree (rom_desc);
|
|
kfree (ti_manuf_desc);
|
|
return -ENOMEM;
|
|
}
|
|
|
|
dbg ("%s - Found Type BLANK FIRMWARE (Type F2) record", __FUNCTION__);
|
|
|
|
// In order to update the I2C firmware we must change the type 2 record to type 0xF2.
|
|
// This will force the UMP to come up in Boot Mode. Then while in boot mode, the driver
|
|
// will download the latest firmware (padded to 15.5k) into the UMP ram.
|
|
// And finally when the device comes back up in download mode the driver will cause
|
|
// the new firmware to be copied from the UMP Ram to I2C and the firmware will update
|
|
// the record type from 0xf2 to 0x02.
|
|
status = BuildI2CFirmwareHeader(header, dev);
|
|
if (status) {
|
|
kfree (vheader);
|
|
kfree (header);
|
|
kfree (rom_desc);
|
|
kfree (ti_manuf_desc);
|
|
return status;
|
|
}
|
|
|
|
// Update I2C with type 0xf2 record with correct size and checksum
|
|
status = TIWriteRom (serial,
|
|
start_address,
|
|
HEADER_SIZE,
|
|
header);
|
|
if (status) {
|
|
kfree (vheader);
|
|
kfree (header);
|
|
kfree (rom_desc);
|
|
kfree (ti_manuf_desc);
|
|
return status;
|
|
}
|
|
|
|
// verify the write -- must do this in order for write to
|
|
// complete before we do the hardware reset
|
|
status = TIReadRom (serial,
|
|
start_address,
|
|
HEADER_SIZE,
|
|
vheader);
|
|
|
|
if (status) {
|
|
dbg ("%s - can't read header back", __FUNCTION__);
|
|
kfree (vheader);
|
|
kfree (header);
|
|
kfree (rom_desc);
|
|
kfree (ti_manuf_desc);
|
|
return status;
|
|
}
|
|
if (memcmp(vheader, header, HEADER_SIZE)) {
|
|
dbg ("%s - write download record failed", __FUNCTION__);
|
|
kfree (vheader);
|
|
kfree (header);
|
|
kfree (rom_desc);
|
|
kfree (ti_manuf_desc);
|
|
return status;
|
|
}
|
|
|
|
kfree (vheader);
|
|
kfree (header);
|
|
|
|
dbg ("%s - Start firmware update", __FUNCTION__);
|
|
|
|
// Tell firmware to copy download image into I2C
|
|
status = TISendVendorRequestSync (serial->serial->dev,
|
|
UMPC_COPY_DNLD_TO_I2C, // Request
|
|
0, // wValue
|
|
0, // wIndex
|
|
NULL, // TransferBuffer
|
|
0); // TransferBufferLength
|
|
|
|
dbg ("%s - Update complete 0x%x", __FUNCTION__, status);
|
|
if (status) {
|
|
dev_err (dev, "%s - UMPC_COPY_DNLD_TO_I2C failed\n", __FUNCTION__);
|
|
kfree (rom_desc);
|
|
kfree (ti_manuf_desc);
|
|
return status;
|
|
}
|
|
}
|
|
|
|
// The device is running the download code
|
|
kfree (rom_desc);
|
|
kfree (ti_manuf_desc);
|
|
return 0;
|
|
}
|
|
|
|
/********************************************************************/
|
|
/* Boot Mode */
|
|
/********************************************************************/
|
|
dbg ("%s - <<<<<<<<<<<<<<<RUNNING IN BOOT MODE>>>>>>>>>>>>>>>",
|
|
__FUNCTION__);
|
|
|
|
// Configure the TI device so we can use the BULK pipes for download
|
|
status = TIConfigureBootDevice (serial->serial->dev);
|
|
if (status)
|
|
return status;
|
|
|
|
if (le16_to_cpu(serial->serial->dev->descriptor.idVendor) != USB_VENDOR_ID_ION) {
|
|
dbg ("%s - VID = 0x%x", __FUNCTION__,
|
|
le16_to_cpu(serial->serial->dev->descriptor.idVendor));
|
|
serial->TI_I2C_Type = DTK_ADDR_SPACE_I2C_TYPE_II;
|
|
goto StayInBootMode;
|
|
}
|
|
|
|
// We have an ION device (I2c Must be programmed)
|
|
// Determine I2C image type
|
|
if (TIGetI2cTypeInBootMode(serial)) {
|
|
goto StayInBootMode;
|
|
}
|
|
|
|
// Registry variable set?
|
|
if (TIStayInBootMode) {
|
|
dbg ("%s - TIStayInBootMode", __FUNCTION__);
|
|
goto StayInBootMode;
|
|
}
|
|
|
|
// Check for ION Vendor ID and that the I2C is valid
|
|
if (!TiValidateI2cImage(serial)) {
|
|
struct ti_i2c_image_header *header;
|
|
int i;
|
|
__u8 cs = 0;
|
|
__u8 *buffer;
|
|
int buffer_size;
|
|
|
|
/* Validate Hardware version number
|
|
* Read Manufacturing Descriptor from TI Based Edgeport
|
|
*/
|
|
ti_manuf_desc = kmalloc (sizeof (*ti_manuf_desc), GFP_KERNEL);
|
|
if (!ti_manuf_desc) {
|
|
dev_err (dev, "%s - out of memory.\n", __FUNCTION__);
|
|
return -ENOMEM;
|
|
}
|
|
status = TIReadManufDescriptor (serial, (__u8 *)ti_manuf_desc);
|
|
if (status) {
|
|
kfree (ti_manuf_desc);
|
|
goto StayInBootMode;
|
|
}
|
|
|
|
// Check for version 2
|
|
if (!ignore_cpu_rev && TI_GET_CPU_REVISION(ti_manuf_desc->CpuRev_BoardRev) < 2) {
|
|
dbg ("%s - Wrong CPU Rev %d (Must be 2)", __FUNCTION__,
|
|
TI_GET_CPU_REVISION(ti_manuf_desc->CpuRev_BoardRev));
|
|
kfree (ti_manuf_desc);
|
|
goto StayInBootMode;
|
|
}
|
|
|
|
kfree (ti_manuf_desc);
|
|
|
|
// In order to update the I2C firmware we must change the type 2 record to type 0xF2.
|
|
// This will force the UMP to come up in Boot Mode. Then while in boot mode, the driver
|
|
// will download the latest firmware (padded to 15.5k) into the UMP ram.
|
|
// And finally when the device comes back up in download mode the driver will cause
|
|
// the new firmware to be copied from the UMP Ram to I2C and the firmware will update
|
|
// the record type from 0xf2 to 0x02.
|
|
|
|
/*
|
|
* Do we really have to copy the whole firmware image,
|
|
* or could we do this in place!
|
|
*/
|
|
|
|
// Allocate a 15.5k buffer + 3 byte header
|
|
buffer_size = (((1024 * 16) - 512) + sizeof(struct ti_i2c_image_header));
|
|
buffer = kmalloc (buffer_size, GFP_KERNEL);
|
|
if (!buffer) {
|
|
dev_err (dev, "%s - out of memory\n", __FUNCTION__);
|
|
return -ENOMEM;
|
|
}
|
|
|
|
// Initialize the buffer to 0xff (pad the buffer)
|
|
memset (buffer, 0xff, buffer_size);
|
|
|
|
memcpy (buffer, &PagableOperationalCodeImage[0], PagableOperationalCodeSize);
|
|
|
|
for(i = sizeof(struct ti_i2c_image_header); i < buffer_size; i++) {
|
|
cs = (__u8)(cs + buffer[i]);
|
|
}
|
|
|
|
header = (struct ti_i2c_image_header *)buffer;
|
|
|
|
// update length and checksum after padding
|
|
header->Length = cpu_to_le16((__u16)(buffer_size - sizeof(struct ti_i2c_image_header)));
|
|
header->CheckSum = cs;
|
|
|
|
// Download the operational code
|
|
dbg ("%s - Downloading operational code image (TI UMP)", __FUNCTION__);
|
|
status = TIDownloadCodeImage (serial, buffer, buffer_size);
|
|
|
|
kfree (buffer);
|
|
|
|
if (status) {
|
|
dbg ("%s - Error downloading operational code image", __FUNCTION__);
|
|
return status;
|
|
}
|
|
|
|
// Device will reboot
|
|
serial->product_info.TiMode = TI_MODE_TRANSITIONING;
|
|
|
|
dbg ("%s - Download successful -- Device rebooting...", __FUNCTION__);
|
|
|
|
/* return an error on purpose */
|
|
return -ENODEV;
|
|
}
|
|
|
|
StayInBootMode:
|
|
// Eprom is invalid or blank stay in boot mode
|
|
dbg ("%s - <<<<<<<<<<<<<<<STAYING IN BOOT MODE>>>>>>>>>>>>", __FUNCTION__);
|
|
serial->product_info.TiMode = TI_MODE_BOOT;
|
|
|
|
return 0;
|
|
}
|
|
|
|
|
|
static int TISetDtr (struct edgeport_port *port)
|
|
{
|
|
int port_number = port->port->number - port->port->serial->minor;
|
|
|
|
dbg ("%s", __FUNCTION__);
|
|
port->shadow_mcr |= MCR_DTR;
|
|
|
|
return TIWriteCommandSync (port->port->serial->dev,
|
|
UMPC_SET_CLR_DTR,
|
|
(__u8)(UMPM_UART1_PORT + port_number),
|
|
1, /* set */
|
|
NULL,
|
|
0);
|
|
}
|
|
|
|
static int TIClearDtr (struct edgeport_port *port)
|
|
{
|
|
int port_number = port->port->number - port->port->serial->minor;
|
|
|
|
dbg ("%s", __FUNCTION__);
|
|
port->shadow_mcr &= ~MCR_DTR;
|
|
|
|
return TIWriteCommandSync (port->port->serial->dev,
|
|
UMPC_SET_CLR_DTR,
|
|
(__u8)(UMPM_UART1_PORT + port_number),
|
|
0, /* clear */
|
|
NULL,
|
|
0);
|
|
}
|
|
|
|
static int TISetRts (struct edgeport_port *port)
|
|
{
|
|
int port_number = port->port->number - port->port->serial->minor;
|
|
|
|
dbg ("%s", __FUNCTION__);
|
|
port->shadow_mcr |= MCR_RTS;
|
|
|
|
return TIWriteCommandSync (port->port->serial->dev,
|
|
UMPC_SET_CLR_RTS,
|
|
(__u8)(UMPM_UART1_PORT + port_number),
|
|
1, /* set */
|
|
NULL,
|
|
0);
|
|
}
|
|
|
|
static int TIClearRts (struct edgeport_port *port)
|
|
{
|
|
int port_number = port->port->number - port->port->serial->minor;
|
|
|
|
dbg ("%s", __FUNCTION__);
|
|
port->shadow_mcr &= ~MCR_RTS;
|
|
|
|
return TIWriteCommandSync (port->port->serial->dev,
|
|
UMPC_SET_CLR_RTS,
|
|
(__u8)(UMPM_UART1_PORT + port_number),
|
|
0, /* clear */
|
|
NULL,
|
|
0);
|
|
}
|
|
|
|
static int TISetLoopBack (struct edgeport_port *port)
|
|
{
|
|
int port_number = port->port->number - port->port->serial->minor;
|
|
|
|
dbg ("%s", __FUNCTION__);
|
|
|
|
return TIWriteCommandSync (port->port->serial->dev,
|
|
UMPC_SET_CLR_LOOPBACK,
|
|
(__u8)(UMPM_UART1_PORT + port_number),
|
|
1, /* set */
|
|
NULL,
|
|
0);
|
|
}
|
|
|
|
static int TIClearLoopBack (struct edgeport_port *port)
|
|
{
|
|
int port_number = port->port->number - port->port->serial->minor;
|
|
|
|
dbg ("%s", __FUNCTION__);
|
|
|
|
return TIWriteCommandSync (port->port->serial->dev,
|
|
UMPC_SET_CLR_LOOPBACK,
|
|
(__u8)(UMPM_UART1_PORT + port_number),
|
|
0, /* clear */
|
|
NULL,
|
|
0);
|
|
}
|
|
|
|
static int TISetBreak (struct edgeport_port *port)
|
|
{
|
|
int port_number = port->port->number - port->port->serial->minor;
|
|
|
|
dbg ("%s", __FUNCTION__);
|
|
|
|
return TIWriteCommandSync (port->port->serial->dev,
|
|
UMPC_SET_CLR_BREAK,
|
|
(__u8)(UMPM_UART1_PORT + port_number),
|
|
1, /* set */
|
|
NULL,
|
|
0);
|
|
}
|
|
|
|
static int TIClearBreak (struct edgeport_port *port)
|
|
{
|
|
int port_number = port->port->number - port->port->serial->minor;
|
|
|
|
dbg ("%s", __FUNCTION__);
|
|
|
|
return TIWriteCommandSync (port->port->serial->dev,
|
|
UMPC_SET_CLR_BREAK,
|
|
(__u8)(UMPM_UART1_PORT + port_number),
|
|
0, /* clear */
|
|
NULL,
|
|
0);
|
|
}
|
|
|
|
static int TIRestoreMCR (struct edgeport_port *port, __u8 mcr)
|
|
{
|
|
int status = 0;
|
|
|
|
dbg ("%s - %x", __FUNCTION__, mcr);
|
|
|
|
if (mcr & MCR_DTR)
|
|
status = TISetDtr (port);
|
|
else
|
|
status = TIClearDtr (port);
|
|
|
|
if (status)
|
|
return status;
|
|
|
|
if (mcr & MCR_RTS)
|
|
status = TISetRts (port);
|
|
else
|
|
status = TIClearRts (port);
|
|
|
|
if (status)
|
|
return status;
|
|
|
|
if (mcr & MCR_LOOPBACK)
|
|
status = TISetLoopBack (port);
|
|
else
|
|
status = TIClearLoopBack (port);
|
|
|
|
return status;
|
|
}
|
|
|
|
|
|
|
|
/* Convert TI LSR to standard UART flags */
|
|
static __u8 MapLineStatus (__u8 ti_lsr)
|
|
{
|
|
__u8 lsr = 0;
|
|
|
|
#define MAP_FLAG(flagUmp, flagUart) \
|
|
if (ti_lsr & flagUmp) \
|
|
lsr |= flagUart;
|
|
|
|
MAP_FLAG(UMP_UART_LSR_OV_MASK, LSR_OVER_ERR) /* overrun */
|
|
MAP_FLAG(UMP_UART_LSR_PE_MASK, LSR_PAR_ERR) /* parity error */
|
|
MAP_FLAG(UMP_UART_LSR_FE_MASK, LSR_FRM_ERR) /* framing error */
|
|
MAP_FLAG(UMP_UART_LSR_BR_MASK, LSR_BREAK) /* break detected */
|
|
MAP_FLAG(UMP_UART_LSR_RX_MASK, LSR_RX_AVAIL) /* receive data available */
|
|
MAP_FLAG(UMP_UART_LSR_TX_MASK, LSR_TX_EMPTY) /* transmit holding register empty */
|
|
|
|
#undef MAP_FLAG
|
|
|
|
return lsr;
|
|
}
|
|
|
|
static void handle_new_msr (struct edgeport_port *edge_port, __u8 msr)
|
|
{
|
|
struct async_icount *icount;
|
|
struct tty_struct *tty;
|
|
|
|
dbg ("%s - %02x", __FUNCTION__, msr);
|
|
|
|
if (msr & (EDGEPORT_MSR_DELTA_CTS | EDGEPORT_MSR_DELTA_DSR | EDGEPORT_MSR_DELTA_RI | EDGEPORT_MSR_DELTA_CD)) {
|
|
icount = &edge_port->icount;
|
|
|
|
/* update input line counters */
|
|
if (msr & EDGEPORT_MSR_DELTA_CTS)
|
|
icount->cts++;
|
|
if (msr & EDGEPORT_MSR_DELTA_DSR)
|
|
icount->dsr++;
|
|
if (msr & EDGEPORT_MSR_DELTA_CD)
|
|
icount->dcd++;
|
|
if (msr & EDGEPORT_MSR_DELTA_RI)
|
|
icount->rng++;
|
|
wake_up_interruptible (&edge_port->delta_msr_wait);
|
|
}
|
|
|
|
/* Save the new modem status */
|
|
edge_port->shadow_msr = msr & 0xf0;
|
|
|
|
tty = edge_port->port->tty;
|
|
/* handle CTS flow control */
|
|
if (tty && C_CRTSCTS(tty)) {
|
|
if (msr & EDGEPORT_MSR_CTS) {
|
|
tty->hw_stopped = 0;
|
|
tty_wakeup(tty);
|
|
} else {
|
|
tty->hw_stopped = 1;
|
|
}
|
|
}
|
|
|
|
return;
|
|
}
|
|
|
|
static void handle_new_lsr (struct edgeport_port *edge_port, int lsr_data, __u8 lsr, __u8 data)
|
|
{
|
|
struct async_icount *icount;
|
|
__u8 new_lsr = (__u8)(lsr & (__u8)(LSR_OVER_ERR | LSR_PAR_ERR | LSR_FRM_ERR | LSR_BREAK));
|
|
|
|
dbg ("%s - %02x", __FUNCTION__, new_lsr);
|
|
|
|
edge_port->shadow_lsr = lsr;
|
|
|
|
if (new_lsr & LSR_BREAK) {
|
|
/*
|
|
* Parity and Framing errors only count if they
|
|
* occur exclusive of a break being received.
|
|
*/
|
|
new_lsr &= (__u8)(LSR_OVER_ERR | LSR_BREAK);
|
|
}
|
|
|
|
/* Place LSR data byte into Rx buffer */
|
|
if (lsr_data && edge_port->port->tty)
|
|
edge_tty_recv(&edge_port->port->dev, edge_port->port->tty, &data, 1);
|
|
|
|
/* update input line counters */
|
|
icount = &edge_port->icount;
|
|
if (new_lsr & LSR_BREAK)
|
|
icount->brk++;
|
|
if (new_lsr & LSR_OVER_ERR)
|
|
icount->overrun++;
|
|
if (new_lsr & LSR_PAR_ERR)
|
|
icount->parity++;
|
|
if (new_lsr & LSR_FRM_ERR)
|
|
icount->frame++;
|
|
}
|
|
|
|
|
|
static void edge_interrupt_callback (struct urb *urb, struct pt_regs *regs)
|
|
{
|
|
struct edgeport_serial *edge_serial = (struct edgeport_serial *)urb->context;
|
|
struct usb_serial_port *port;
|
|
struct edgeport_port *edge_port;
|
|
unsigned char *data = urb->transfer_buffer;
|
|
int length = urb->actual_length;
|
|
int port_number;
|
|
int function;
|
|
int status;
|
|
__u8 lsr;
|
|
__u8 msr;
|
|
|
|
dbg("%s", __FUNCTION__);
|
|
|
|
switch (urb->status) {
|
|
case 0:
|
|
/* success */
|
|
break;
|
|
case -ECONNRESET:
|
|
case -ENOENT:
|
|
case -ESHUTDOWN:
|
|
/* this urb is terminated, clean up */
|
|
dbg("%s - urb shutting down with status: %d", __FUNCTION__, urb->status);
|
|
return;
|
|
default:
|
|
dev_err(&urb->dev->dev, "%s - nonzero urb status received: %d\n", __FUNCTION__, urb->status);
|
|
goto exit;
|
|
}
|
|
|
|
if (!length) {
|
|
dbg ("%s - no data in urb", __FUNCTION__);
|
|
goto exit;
|
|
}
|
|
|
|
usb_serial_debug_data(debug, &edge_serial->serial->dev->dev, __FUNCTION__, length, data);
|
|
|
|
if (length != 2) {
|
|
dbg ("%s - expecting packet of size 2, got %d", __FUNCTION__, length);
|
|
goto exit;
|
|
}
|
|
|
|
port_number = TIUMP_GET_PORT_FROM_CODE (data[0]);
|
|
function = TIUMP_GET_FUNC_FROM_CODE (data[0]);
|
|
dbg ("%s - port_number %d, function %d, info 0x%x",
|
|
__FUNCTION__, port_number, function, data[1]);
|
|
port = edge_serial->serial->port[port_number];
|
|
edge_port = usb_get_serial_port_data(port);
|
|
if (!edge_port) {
|
|
dbg ("%s - edge_port not found", __FUNCTION__);
|
|
return;
|
|
}
|
|
switch (function) {
|
|
case TIUMP_INTERRUPT_CODE_LSR:
|
|
lsr = MapLineStatus(data[1]);
|
|
if (lsr & UMP_UART_LSR_DATA_MASK) {
|
|
/* Save the LSR event for bulk read completion routine */
|
|
dbg ("%s - LSR Event Port %u LSR Status = %02x",
|
|
__FUNCTION__, port_number, lsr);
|
|
edge_port->lsr_event = 1;
|
|
edge_port->lsr_mask = lsr;
|
|
} else {
|
|
dbg ("%s - ===== Port %d LSR Status = %02x ======",
|
|
__FUNCTION__, port_number, lsr);
|
|
handle_new_lsr (edge_port, 0, lsr, 0);
|
|
}
|
|
break;
|
|
|
|
case TIUMP_INTERRUPT_CODE_MSR: // MSR
|
|
/* Copy MSR from UMP */
|
|
msr = data[1];
|
|
dbg ("%s - ===== Port %u MSR Status = %02x ======\n",
|
|
__FUNCTION__, port_number, msr);
|
|
handle_new_msr (edge_port, msr);
|
|
break;
|
|
|
|
default:
|
|
dev_err (&urb->dev->dev, "%s - Unknown Interrupt code from UMP %x\n",
|
|
__FUNCTION__, data[1]);
|
|
break;
|
|
|
|
}
|
|
|
|
exit:
|
|
status = usb_submit_urb (urb, GFP_ATOMIC);
|
|
if (status)
|
|
dev_err (&urb->dev->dev, "%s - usb_submit_urb failed with result %d\n",
|
|
__FUNCTION__, status);
|
|
}
|
|
|
|
static void edge_bulk_in_callback (struct urb *urb, struct pt_regs *regs)
|
|
{
|
|
struct edgeport_port *edge_port = (struct edgeport_port *)urb->context;
|
|
unsigned char *data = urb->transfer_buffer;
|
|
struct tty_struct *tty;
|
|
int status = 0;
|
|
int port_number;
|
|
|
|
dbg("%s", __FUNCTION__);
|
|
|
|
switch (urb->status) {
|
|
case 0:
|
|
/* success */
|
|
break;
|
|
case -ECONNRESET:
|
|
case -ENOENT:
|
|
case -ESHUTDOWN:
|
|
/* this urb is terminated, clean up */
|
|
dbg("%s - urb shutting down with status: %d", __FUNCTION__, urb->status);
|
|
return;
|
|
default:
|
|
dev_err (&urb->dev->dev,"%s - nonzero read bulk status received: %d\n",
|
|
__FUNCTION__, urb->status );
|
|
}
|
|
|
|
if (urb->status == -EPIPE)
|
|
goto exit;
|
|
|
|
if (urb->status) {
|
|
dev_err(&urb->dev->dev,"%s - stopping read!\n", __FUNCTION__);
|
|
return;
|
|
}
|
|
|
|
port_number = edge_port->port->number - edge_port->port->serial->minor;
|
|
|
|
if (edge_port->lsr_event) {
|
|
edge_port->lsr_event = 0;
|
|
dbg ("%s ===== Port %u LSR Status = %02x, Data = %02x ======",
|
|
__FUNCTION__, port_number, edge_port->lsr_mask, *data);
|
|
handle_new_lsr (edge_port, 1, edge_port->lsr_mask, *data);
|
|
/* Adjust buffer length/pointer */
|
|
--urb->actual_length;
|
|
++data;
|
|
}
|
|
|
|
tty = edge_port->port->tty;
|
|
if (tty && urb->actual_length) {
|
|
usb_serial_debug_data(debug, &edge_port->port->dev, __FUNCTION__, urb->actual_length, data);
|
|
|
|
if (edge_port->close_pending) {
|
|
dbg ("%s - close is pending, dropping data on the floor.", __FUNCTION__);
|
|
} else {
|
|
edge_tty_recv(&edge_port->port->dev, tty, data, urb->actual_length);
|
|
}
|
|
edge_port->icount.rx += urb->actual_length;
|
|
}
|
|
|
|
exit:
|
|
/* continue read unless stopped */
|
|
spin_lock(&edge_port->ep_lock);
|
|
if (edge_port->ep_read_urb_state == EDGE_READ_URB_RUNNING) {
|
|
urb->dev = edge_port->port->serial->dev;
|
|
status = usb_submit_urb(urb, GFP_ATOMIC);
|
|
} else if (edge_port->ep_read_urb_state == EDGE_READ_URB_STOPPING) {
|
|
edge_port->ep_read_urb_state = EDGE_READ_URB_STOPPED;
|
|
}
|
|
spin_unlock(&edge_port->ep_lock);
|
|
if (status)
|
|
dev_err (&urb->dev->dev, "%s - usb_submit_urb failed with result %d\n",
|
|
__FUNCTION__, status);
|
|
}
|
|
|
|
static void edge_tty_recv(struct device *dev, struct tty_struct *tty, unsigned char *data, int length)
|
|
{
|
|
int cnt;
|
|
|
|
do {
|
|
cnt = tty_buffer_request_room(tty, length);
|
|
if (cnt < length) {
|
|
dev_err(dev, "%s - dropping data, %d bytes lost\n",
|
|
__FUNCTION__, length - cnt);
|
|
if(cnt == 0)
|
|
break;
|
|
}
|
|
tty_insert_flip_string(tty, data, cnt);
|
|
data += cnt;
|
|
length -= cnt;
|
|
} while (length > 0);
|
|
|
|
tty_flip_buffer_push(tty);
|
|
}
|
|
|
|
static void edge_bulk_out_callback (struct urb *urb, struct pt_regs *regs)
|
|
{
|
|
struct usb_serial_port *port = (struct usb_serial_port *)urb->context;
|
|
struct edgeport_port *edge_port = usb_get_serial_port_data(port);
|
|
|
|
dbg ("%s - port %d", __FUNCTION__, port->number);
|
|
|
|
edge_port->ep_write_urb_in_use = 0;
|
|
|
|
switch (urb->status) {
|
|
case 0:
|
|
/* success */
|
|
break;
|
|
case -ECONNRESET:
|
|
case -ENOENT:
|
|
case -ESHUTDOWN:
|
|
/* this urb is terminated, clean up */
|
|
dbg("%s - urb shutting down with status: %d", __FUNCTION__, urb->status);
|
|
return;
|
|
default:
|
|
dev_err (&urb->dev->dev,"%s - nonzero write bulk status received: %d\n",
|
|
__FUNCTION__, urb->status);
|
|
}
|
|
|
|
/* send any buffered data */
|
|
edge_send(port);
|
|
}
|
|
|
|
static int edge_open (struct usb_serial_port *port, struct file * filp)
|
|
{
|
|
struct edgeport_port *edge_port = usb_get_serial_port_data(port);
|
|
struct edgeport_serial *edge_serial;
|
|
struct usb_device *dev;
|
|
struct urb *urb;
|
|
int port_number;
|
|
int status;
|
|
u16 open_settings;
|
|
u8 transaction_timeout;
|
|
|
|
dbg("%s - port %d", __FUNCTION__, port->number);
|
|
|
|
if (edge_port == NULL)
|
|
return -ENODEV;
|
|
|
|
if (port->tty)
|
|
port->tty->low_latency = low_latency;
|
|
|
|
port_number = port->number - port->serial->minor;
|
|
switch (port_number) {
|
|
case 0:
|
|
edge_port->uart_base = UMPMEM_BASE_UART1;
|
|
edge_port->dma_address = UMPD_OEDB1_ADDRESS;
|
|
break;
|
|
case 1:
|
|
edge_port->uart_base = UMPMEM_BASE_UART2;
|
|
edge_port->dma_address = UMPD_OEDB2_ADDRESS;
|
|
break;
|
|
default:
|
|
dev_err (&port->dev, "Unknown port number!!!\n");
|
|
return -ENODEV;
|
|
}
|
|
|
|
dbg ("%s - port_number = %d, uart_base = %04x, dma_address = %04x",
|
|
__FUNCTION__, port_number, edge_port->uart_base, edge_port->dma_address);
|
|
|
|
dev = port->serial->dev;
|
|
|
|
memset (&(edge_port->icount), 0x00, sizeof(edge_port->icount));
|
|
init_waitqueue_head (&edge_port->delta_msr_wait);
|
|
|
|
/* turn off loopback */
|
|
status = TIClearLoopBack (edge_port);
|
|
if (status) {
|
|
dev_err(&port->dev,"%s - cannot send clear loopback command, %d\n",
|
|
__FUNCTION__, status);
|
|
return status;
|
|
}
|
|
|
|
/* set up the port settings */
|
|
edge_set_termios (port, NULL);
|
|
|
|
/* open up the port */
|
|
|
|
/* milliseconds to timeout for DMA transfer */
|
|
transaction_timeout = 2;
|
|
|
|
edge_port->ump_read_timeout = max (20, ((transaction_timeout * 3) / 2) );
|
|
|
|
// milliseconds to timeout for DMA transfer
|
|
open_settings = (u8)(UMP_DMA_MODE_CONTINOUS |
|
|
UMP_PIPE_TRANS_TIMEOUT_ENA |
|
|
(transaction_timeout << 2));
|
|
|
|
dbg ("%s - Sending UMPC_OPEN_PORT", __FUNCTION__);
|
|
|
|
/* Tell TI to open and start the port */
|
|
status = TIWriteCommandSync (dev,
|
|
UMPC_OPEN_PORT,
|
|
(u8)(UMPM_UART1_PORT + port_number),
|
|
open_settings,
|
|
NULL,
|
|
0);
|
|
if (status) {
|
|
dev_err(&port->dev,"%s - cannot send open command, %d\n", __FUNCTION__, status);
|
|
return status;
|
|
}
|
|
|
|
/* Start the DMA? */
|
|
status = TIWriteCommandSync (dev,
|
|
UMPC_START_PORT,
|
|
(u8)(UMPM_UART1_PORT + port_number),
|
|
0,
|
|
NULL,
|
|
0);
|
|
if (status) {
|
|
dev_err(&port->dev,"%s - cannot send start DMA command, %d\n", __FUNCTION__, status);
|
|
return status;
|
|
}
|
|
|
|
/* Clear TX and RX buffers in UMP */
|
|
status = TIPurgeDataSync (port, UMP_PORT_DIR_OUT | UMP_PORT_DIR_IN);
|
|
if (status) {
|
|
dev_err(&port->dev,"%s - cannot send clear buffers command, %d\n", __FUNCTION__, status);
|
|
return status;
|
|
}
|
|
|
|
/* Read Initial MSR */
|
|
status = TIReadVendorRequestSync (dev,
|
|
UMPC_READ_MSR, // Request
|
|
0, // wValue
|
|
(__u16)(UMPM_UART1_PORT + port_number), // wIndex (Address)
|
|
&edge_port->shadow_msr, // TransferBuffer
|
|
1); // TransferBufferLength
|
|
if (status) {
|
|
dev_err(&port->dev,"%s - cannot send read MSR command, %d\n", __FUNCTION__, status);
|
|
return status;
|
|
}
|
|
|
|
dbg ("ShadowMSR 0x%X", edge_port->shadow_msr);
|
|
|
|
/* Set Initial MCR */
|
|
edge_port->shadow_mcr = MCR_RTS | MCR_DTR;
|
|
dbg ("ShadowMCR 0x%X", edge_port->shadow_mcr);
|
|
|
|
edge_serial = edge_port->edge_serial;
|
|
if (down_interruptible(&edge_serial->es_sem))
|
|
return -ERESTARTSYS;
|
|
if (edge_serial->num_ports_open == 0) {
|
|
/* we are the first port to be opened, let's post the interrupt urb */
|
|
urb = edge_serial->serial->port[0]->interrupt_in_urb;
|
|
if (!urb) {
|
|
dev_err (&port->dev, "%s - no interrupt urb present, exiting\n", __FUNCTION__);
|
|
status = -EINVAL;
|
|
goto up_es_sem;
|
|
}
|
|
urb->complete = edge_interrupt_callback;
|
|
urb->context = edge_serial;
|
|
urb->dev = dev;
|
|
status = usb_submit_urb (urb, GFP_KERNEL);
|
|
if (status) {
|
|
dev_err (&port->dev, "%s - usb_submit_urb failed with value %d\n", __FUNCTION__, status);
|
|
goto up_es_sem;
|
|
}
|
|
}
|
|
|
|
/*
|
|
* reset the data toggle on the bulk endpoints to work around bug in
|
|
* host controllers where things get out of sync some times
|
|
*/
|
|
usb_clear_halt (dev, port->write_urb->pipe);
|
|
usb_clear_halt (dev, port->read_urb->pipe);
|
|
|
|
/* start up our bulk read urb */
|
|
urb = port->read_urb;
|
|
if (!urb) {
|
|
dev_err (&port->dev, "%s - no read urb present, exiting\n", __FUNCTION__);
|
|
status = -EINVAL;
|
|
goto unlink_int_urb;
|
|
}
|
|
edge_port->ep_read_urb_state = EDGE_READ_URB_RUNNING;
|
|
urb->complete = edge_bulk_in_callback;
|
|
urb->context = edge_port;
|
|
urb->dev = dev;
|
|
status = usb_submit_urb (urb, GFP_KERNEL);
|
|
if (status) {
|
|
dev_err (&port->dev, "%s - read bulk usb_submit_urb failed with value %d\n", __FUNCTION__, status);
|
|
goto unlink_int_urb;
|
|
}
|
|
|
|
++edge_serial->num_ports_open;
|
|
|
|
dbg("%s - exited", __FUNCTION__);
|
|
|
|
goto up_es_sem;
|
|
|
|
unlink_int_urb:
|
|
if (edge_port->edge_serial->num_ports_open == 0)
|
|
usb_kill_urb(port->serial->port[0]->interrupt_in_urb);
|
|
up_es_sem:
|
|
up(&edge_serial->es_sem);
|
|
return status;
|
|
}
|
|
|
|
static void edge_close (struct usb_serial_port *port, struct file *filp)
|
|
{
|
|
struct edgeport_serial *edge_serial;
|
|
struct edgeport_port *edge_port;
|
|
int port_number;
|
|
int status;
|
|
|
|
dbg("%s - port %d", __FUNCTION__, port->number);
|
|
|
|
edge_serial = usb_get_serial_data(port->serial);
|
|
edge_port = usb_get_serial_port_data(port);
|
|
if ((edge_serial == NULL) || (edge_port == NULL))
|
|
return;
|
|
|
|
/* The bulkreadcompletion routine will check
|
|
* this flag and dump add read data */
|
|
edge_port->close_pending = 1;
|
|
|
|
/* chase the port close and flush */
|
|
TIChasePort (edge_port, (HZ*closing_wait)/100, 1);
|
|
|
|
usb_kill_urb(port->read_urb);
|
|
usb_kill_urb(port->write_urb);
|
|
edge_port->ep_write_urb_in_use = 0;
|
|
|
|
/* assuming we can still talk to the device,
|
|
* send a close port command to it */
|
|
dbg("%s - send umpc_close_port", __FUNCTION__);
|
|
port_number = port->number - port->serial->minor;
|
|
status = TIWriteCommandSync (port->serial->dev,
|
|
UMPC_CLOSE_PORT,
|
|
(__u8)(UMPM_UART1_PORT + port_number),
|
|
0,
|
|
NULL,
|
|
0);
|
|
down(&edge_serial->es_sem);
|
|
--edge_port->edge_serial->num_ports_open;
|
|
if (edge_port->edge_serial->num_ports_open <= 0) {
|
|
/* last port is now closed, let's shut down our interrupt urb */
|
|
usb_kill_urb(port->serial->port[0]->interrupt_in_urb);
|
|
edge_port->edge_serial->num_ports_open = 0;
|
|
}
|
|
up(&edge_serial->es_sem);
|
|
edge_port->close_pending = 0;
|
|
|
|
dbg("%s - exited", __FUNCTION__);
|
|
}
|
|
|
|
static int edge_write (struct usb_serial_port *port, const unsigned char *data, int count)
|
|
{
|
|
struct edgeport_port *edge_port = usb_get_serial_port_data(port);
|
|
unsigned long flags;
|
|
|
|
dbg("%s - port %d", __FUNCTION__, port->number);
|
|
|
|
if (count == 0) {
|
|
dbg("%s - write request of 0 bytes", __FUNCTION__);
|
|
return 0;
|
|
}
|
|
|
|
if (edge_port == NULL)
|
|
return -ENODEV;
|
|
if (edge_port->close_pending == 1)
|
|
return -ENODEV;
|
|
|
|
spin_lock_irqsave(&edge_port->ep_lock, flags);
|
|
count = edge_buf_put(edge_port->ep_out_buf, data, count);
|
|
spin_unlock_irqrestore(&edge_port->ep_lock, flags);
|
|
|
|
edge_send(port);
|
|
|
|
return count;
|
|
}
|
|
|
|
static void edge_send(struct usb_serial_port *port)
|
|
{
|
|
int count, result;
|
|
struct edgeport_port *edge_port = usb_get_serial_port_data(port);
|
|
struct tty_struct *tty = port->tty;
|
|
unsigned long flags;
|
|
|
|
|
|
dbg("%s - port %d", __FUNCTION__, port->number);
|
|
|
|
spin_lock_irqsave(&edge_port->ep_lock, flags);
|
|
|
|
if (edge_port->ep_write_urb_in_use) {
|
|
spin_unlock_irqrestore(&edge_port->ep_lock, flags);
|
|
return;
|
|
}
|
|
|
|
count = edge_buf_get(edge_port->ep_out_buf,
|
|
port->write_urb->transfer_buffer,
|
|
port->bulk_out_size);
|
|
|
|
if (count == 0) {
|
|
spin_unlock_irqrestore(&edge_port->ep_lock, flags);
|
|
return;
|
|
}
|
|
|
|
edge_port->ep_write_urb_in_use = 1;
|
|
|
|
spin_unlock_irqrestore(&edge_port->ep_lock, flags);
|
|
|
|
usb_serial_debug_data(debug, &port->dev, __FUNCTION__, count, port->write_urb->transfer_buffer);
|
|
|
|
/* set up our urb */
|
|
usb_fill_bulk_urb (port->write_urb, port->serial->dev,
|
|
usb_sndbulkpipe (port->serial->dev,
|
|
port->bulk_out_endpointAddress),
|
|
port->write_urb->transfer_buffer, count,
|
|
edge_bulk_out_callback,
|
|
port);
|
|
|
|
/* send the data out the bulk port */
|
|
result = usb_submit_urb(port->write_urb, GFP_ATOMIC);
|
|
if (result) {
|
|
dev_err(&port->dev, "%s - failed submitting write urb, error %d\n", __FUNCTION__, result);
|
|
edge_port->ep_write_urb_in_use = 0;
|
|
// TODO: reschedule edge_send
|
|
} else {
|
|
edge_port->icount.tx += count;
|
|
}
|
|
|
|
/* wakeup any process waiting for writes to complete */
|
|
/* there is now more room in the buffer for new writes */
|
|
if (tty) {
|
|
/* let the tty driver wakeup if it has a special write_wakeup function */
|
|
tty_wakeup(tty);
|
|
}
|
|
}
|
|
|
|
static int edge_write_room (struct usb_serial_port *port)
|
|
{
|
|
struct edgeport_port *edge_port = usb_get_serial_port_data(port);
|
|
int room = 0;
|
|
unsigned long flags;
|
|
|
|
dbg("%s - port %d", __FUNCTION__, port->number);
|
|
|
|
if (edge_port == NULL)
|
|
return -ENODEV;
|
|
if (edge_port->close_pending == 1)
|
|
return -ENODEV;
|
|
|
|
spin_lock_irqsave(&edge_port->ep_lock, flags);
|
|
room = edge_buf_space_avail(edge_port->ep_out_buf);
|
|
spin_unlock_irqrestore(&edge_port->ep_lock, flags);
|
|
|
|
dbg("%s - returns %d", __FUNCTION__, room);
|
|
return room;
|
|
}
|
|
|
|
static int edge_chars_in_buffer (struct usb_serial_port *port)
|
|
{
|
|
struct edgeport_port *edge_port = usb_get_serial_port_data(port);
|
|
int chars = 0;
|
|
unsigned long flags;
|
|
|
|
dbg("%s - port %d", __FUNCTION__, port->number);
|
|
|
|
if (edge_port == NULL)
|
|
return -ENODEV;
|
|
if (edge_port->close_pending == 1)
|
|
return -ENODEV;
|
|
|
|
spin_lock_irqsave(&edge_port->ep_lock, flags);
|
|
chars = edge_buf_data_avail(edge_port->ep_out_buf);
|
|
spin_unlock_irqrestore(&edge_port->ep_lock, flags);
|
|
|
|
dbg ("%s - returns %d", __FUNCTION__, chars);
|
|
return chars;
|
|
}
|
|
|
|
static void edge_throttle (struct usb_serial_port *port)
|
|
{
|
|
struct edgeport_port *edge_port = usb_get_serial_port_data(port);
|
|
struct tty_struct *tty;
|
|
int status;
|
|
|
|
dbg("%s - port %d", __FUNCTION__, port->number);
|
|
|
|
if (edge_port == NULL)
|
|
return;
|
|
|
|
tty = port->tty;
|
|
if (!tty) {
|
|
dbg ("%s - no tty available", __FUNCTION__);
|
|
return;
|
|
}
|
|
|
|
/* if we are implementing XON/XOFF, send the stop character */
|
|
if (I_IXOFF(tty)) {
|
|
unsigned char stop_char = STOP_CHAR(tty);
|
|
status = edge_write (port, &stop_char, 1);
|
|
if (status <= 0) {
|
|
dev_err(&port->dev, "%s - failed to write stop character, %d\n", __FUNCTION__, status);
|
|
}
|
|
}
|
|
|
|
/* if we are implementing RTS/CTS, stop reads */
|
|
/* and the Edgeport will clear the RTS line */
|
|
if (C_CRTSCTS(tty))
|
|
stop_read(edge_port);
|
|
|
|
}
|
|
|
|
static void edge_unthrottle (struct usb_serial_port *port)
|
|
{
|
|
struct edgeport_port *edge_port = usb_get_serial_port_data(port);
|
|
struct tty_struct *tty;
|
|
int status;
|
|
|
|
dbg("%s - port %d", __FUNCTION__, port->number);
|
|
|
|
if (edge_port == NULL)
|
|
return;
|
|
|
|
tty = port->tty;
|
|
if (!tty) {
|
|
dbg ("%s - no tty available", __FUNCTION__);
|
|
return;
|
|
}
|
|
|
|
/* if we are implementing XON/XOFF, send the start character */
|
|
if (I_IXOFF(tty)) {
|
|
unsigned char start_char = START_CHAR(tty);
|
|
status = edge_write (port, &start_char, 1);
|
|
if (status <= 0) {
|
|
dev_err(&port->dev, "%s - failed to write start character, %d\n", __FUNCTION__, status);
|
|
}
|
|
}
|
|
|
|
/* if we are implementing RTS/CTS, restart reads */
|
|
/* are the Edgeport will assert the RTS line */
|
|
if (C_CRTSCTS(tty)) {
|
|
status = restart_read(edge_port);
|
|
if (status)
|
|
dev_err(&port->dev, "%s - read bulk usb_submit_urb failed with value %d\n", __FUNCTION__, status);
|
|
}
|
|
|
|
}
|
|
|
|
static void stop_read(struct edgeport_port *edge_port)
|
|
{
|
|
unsigned long flags;
|
|
|
|
spin_lock_irqsave(&edge_port->ep_lock, flags);
|
|
|
|
if (edge_port->ep_read_urb_state == EDGE_READ_URB_RUNNING)
|
|
edge_port->ep_read_urb_state = EDGE_READ_URB_STOPPING;
|
|
edge_port->shadow_mcr &= ~MCR_RTS;
|
|
|
|
spin_unlock_irqrestore(&edge_port->ep_lock, flags);
|
|
}
|
|
|
|
static int restart_read(struct edgeport_port *edge_port)
|
|
{
|
|
struct urb *urb;
|
|
int status = 0;
|
|
unsigned long flags;
|
|
|
|
spin_lock_irqsave(&edge_port->ep_lock, flags);
|
|
|
|
if (edge_port->ep_read_urb_state == EDGE_READ_URB_STOPPED) {
|
|
urb = edge_port->port->read_urb;
|
|
urb->complete = edge_bulk_in_callback;
|
|
urb->context = edge_port;
|
|
urb->dev = edge_port->port->serial->dev;
|
|
status = usb_submit_urb(urb, GFP_KERNEL);
|
|
}
|
|
edge_port->ep_read_urb_state = EDGE_READ_URB_RUNNING;
|
|
edge_port->shadow_mcr |= MCR_RTS;
|
|
|
|
spin_unlock_irqrestore(&edge_port->ep_lock, flags);
|
|
|
|
return status;
|
|
}
|
|
|
|
static void change_port_settings (struct edgeport_port *edge_port, struct termios *old_termios)
|
|
{
|
|
struct ump_uart_config *config;
|
|
struct tty_struct *tty;
|
|
int baud;
|
|
unsigned cflag;
|
|
int status;
|
|
int port_number = edge_port->port->number - edge_port->port->serial->minor;
|
|
|
|
dbg("%s - port %d", __FUNCTION__, edge_port->port->number);
|
|
|
|
tty = edge_port->port->tty;
|
|
if ((!tty) ||
|
|
(!tty->termios)) {
|
|
dbg("%s - no tty structures", __FUNCTION__);
|
|
return;
|
|
}
|
|
|
|
config = kmalloc (sizeof (*config), GFP_KERNEL);
|
|
if (!config) {
|
|
dev_err (&edge_port->port->dev, "%s - out of memory\n", __FUNCTION__);
|
|
return;
|
|
}
|
|
|
|
cflag = tty->termios->c_cflag;
|
|
|
|
config->wFlags = 0;
|
|
|
|
/* These flags must be set */
|
|
config->wFlags |= UMP_MASK_UART_FLAGS_RECEIVE_MS_INT;
|
|
config->wFlags |= UMP_MASK_UART_FLAGS_AUTO_START_ON_ERR;
|
|
config->bUartMode = (__u8)(edge_port->bUartMode);
|
|
|
|
switch (cflag & CSIZE) {
|
|
case CS5:
|
|
config->bDataBits = UMP_UART_CHAR5BITS;
|
|
dbg ("%s - data bits = 5", __FUNCTION__);
|
|
break;
|
|
case CS6:
|
|
config->bDataBits = UMP_UART_CHAR6BITS;
|
|
dbg ("%s - data bits = 6", __FUNCTION__);
|
|
break;
|
|
case CS7:
|
|
config->bDataBits = UMP_UART_CHAR7BITS;
|
|
dbg ("%s - data bits = 7", __FUNCTION__);
|
|
break;
|
|
default:
|
|
case CS8:
|
|
config->bDataBits = UMP_UART_CHAR8BITS;
|
|
dbg ("%s - data bits = 8", __FUNCTION__);
|
|
break;
|
|
}
|
|
|
|
if (cflag & PARENB) {
|
|
if (cflag & PARODD) {
|
|
config->wFlags |= UMP_MASK_UART_FLAGS_PARITY;
|
|
config->bParity = UMP_UART_ODDPARITY;
|
|
dbg("%s - parity = odd", __FUNCTION__);
|
|
} else {
|
|
config->wFlags |= UMP_MASK_UART_FLAGS_PARITY;
|
|
config->bParity = UMP_UART_EVENPARITY;
|
|
dbg("%s - parity = even", __FUNCTION__);
|
|
}
|
|
} else {
|
|
config->bParity = UMP_UART_NOPARITY;
|
|
dbg("%s - parity = none", __FUNCTION__);
|
|
}
|
|
|
|
if (cflag & CSTOPB) {
|
|
config->bStopBits = UMP_UART_STOPBIT2;
|
|
dbg("%s - stop bits = 2", __FUNCTION__);
|
|
} else {
|
|
config->bStopBits = UMP_UART_STOPBIT1;
|
|
dbg("%s - stop bits = 1", __FUNCTION__);
|
|
}
|
|
|
|
/* figure out the flow control settings */
|
|
if (cflag & CRTSCTS) {
|
|
config->wFlags |= UMP_MASK_UART_FLAGS_OUT_X_CTS_FLOW;
|
|
config->wFlags |= UMP_MASK_UART_FLAGS_RTS_FLOW;
|
|
dbg("%s - RTS/CTS is enabled", __FUNCTION__);
|
|
} else {
|
|
dbg("%s - RTS/CTS is disabled", __FUNCTION__);
|
|
tty->hw_stopped = 0;
|
|
restart_read(edge_port);
|
|
}
|
|
|
|
/* if we are implementing XON/XOFF, set the start and stop character in the device */
|
|
if (I_IXOFF(tty) || I_IXON(tty)) {
|
|
config->cXon = START_CHAR(tty);
|
|
config->cXoff = STOP_CHAR(tty);
|
|
|
|
/* if we are implementing INBOUND XON/XOFF */
|
|
if (I_IXOFF(tty)) {
|
|
config->wFlags |= UMP_MASK_UART_FLAGS_IN_X;
|
|
dbg ("%s - INBOUND XON/XOFF is enabled, XON = %2x, XOFF = %2x",
|
|
__FUNCTION__, config->cXon, config->cXoff);
|
|
} else {
|
|
dbg ("%s - INBOUND XON/XOFF is disabled", __FUNCTION__);
|
|
}
|
|
|
|
/* if we are implementing OUTBOUND XON/XOFF */
|
|
if (I_IXON(tty)) {
|
|
config->wFlags |= UMP_MASK_UART_FLAGS_OUT_X;
|
|
dbg ("%s - OUTBOUND XON/XOFF is enabled, XON = %2x, XOFF = %2x",
|
|
__FUNCTION__, config->cXon, config->cXoff);
|
|
} else {
|
|
dbg ("%s - OUTBOUND XON/XOFF is disabled", __FUNCTION__);
|
|
}
|
|
}
|
|
|
|
/* Round the baud rate */
|
|
baud = tty_get_baud_rate(tty);
|
|
if (!baud) {
|
|
/* pick a default, any default... */
|
|
baud = 9600;
|
|
}
|
|
edge_port->baud_rate = baud;
|
|
config->wBaudRate = (__u16)((461550L + baud/2) / baud);
|
|
|
|
dbg ("%s - baud rate = %d, wBaudRate = %d", __FUNCTION__, baud, config->wBaudRate);
|
|
|
|
dbg ("wBaudRate: %d", (int)(461550L / config->wBaudRate));
|
|
dbg ("wFlags: 0x%x", config->wFlags);
|
|
dbg ("bDataBits: %d", config->bDataBits);
|
|
dbg ("bParity: %d", config->bParity);
|
|
dbg ("bStopBits: %d", config->bStopBits);
|
|
dbg ("cXon: %d", config->cXon);
|
|
dbg ("cXoff: %d", config->cXoff);
|
|
dbg ("bUartMode: %d", config->bUartMode);
|
|
|
|
/* move the word values into big endian mode */
|
|
cpu_to_be16s (&config->wFlags);
|
|
cpu_to_be16s (&config->wBaudRate);
|
|
|
|
status = TIWriteCommandSync (edge_port->port->serial->dev,
|
|
UMPC_SET_CONFIG,
|
|
(__u8)(UMPM_UART1_PORT + port_number),
|
|
0,
|
|
(__u8 *)config,
|
|
sizeof(*config));
|
|
if (status) {
|
|
dbg ("%s - error %d when trying to write config to device",
|
|
__FUNCTION__, status);
|
|
}
|
|
|
|
kfree (config);
|
|
|
|
return;
|
|
}
|
|
|
|
static void edge_set_termios (struct usb_serial_port *port, struct termios *old_termios)
|
|
{
|
|
struct edgeport_port *edge_port = usb_get_serial_port_data(port);
|
|
struct tty_struct *tty = port->tty;
|
|
unsigned int cflag;
|
|
|
|
if (!port->tty || !port->tty->termios) {
|
|
dbg ("%s - no tty or termios", __FUNCTION__);
|
|
return;
|
|
}
|
|
|
|
cflag = tty->termios->c_cflag;
|
|
/* check that they really want us to change something */
|
|
if (old_termios) {
|
|
if (cflag == old_termios->c_cflag &&
|
|
tty->termios->c_iflag == old_termios->c_iflag) {
|
|
dbg ("%s - nothing to change", __FUNCTION__);
|
|
return;
|
|
}
|
|
}
|
|
|
|
dbg("%s - clfag %08x iflag %08x", __FUNCTION__,
|
|
tty->termios->c_cflag, tty->termios->c_iflag);
|
|
if (old_termios) {
|
|
dbg("%s - old clfag %08x old iflag %08x", __FUNCTION__,
|
|
old_termios->c_cflag, old_termios->c_iflag);
|
|
}
|
|
|
|
dbg("%s - port %d", __FUNCTION__, port->number);
|
|
|
|
if (edge_port == NULL)
|
|
return;
|
|
|
|
/* change the port settings to the new ones specified */
|
|
change_port_settings (edge_port, old_termios);
|
|
|
|
return;
|
|
}
|
|
|
|
static int edge_tiocmset (struct usb_serial_port *port, struct file *file, unsigned int set, unsigned int clear)
|
|
{
|
|
struct edgeport_port *edge_port = usb_get_serial_port_data(port);
|
|
unsigned int mcr;
|
|
|
|
dbg("%s - port %d", __FUNCTION__, port->number);
|
|
|
|
mcr = edge_port->shadow_mcr;
|
|
if (set & TIOCM_RTS)
|
|
mcr |= MCR_RTS;
|
|
if (set & TIOCM_DTR)
|
|
mcr |= MCR_DTR;
|
|
if (set & TIOCM_LOOP)
|
|
mcr |= MCR_LOOPBACK;
|
|
|
|
if (clear & TIOCM_RTS)
|
|
mcr &= ~MCR_RTS;
|
|
if (clear & TIOCM_DTR)
|
|
mcr &= ~MCR_DTR;
|
|
if (clear & TIOCM_LOOP)
|
|
mcr &= ~MCR_LOOPBACK;
|
|
|
|
edge_port->shadow_mcr = mcr;
|
|
|
|
TIRestoreMCR (edge_port, mcr);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int edge_tiocmget(struct usb_serial_port *port, struct file *file)
|
|
{
|
|
struct edgeport_port *edge_port = usb_get_serial_port_data(port);
|
|
unsigned int result = 0;
|
|
unsigned int msr;
|
|
unsigned int mcr;
|
|
|
|
dbg("%s - port %d", __FUNCTION__, port->number);
|
|
|
|
msr = edge_port->shadow_msr;
|
|
mcr = edge_port->shadow_mcr;
|
|
result = ((mcr & MCR_DTR) ? TIOCM_DTR: 0) /* 0x002 */
|
|
| ((mcr & MCR_RTS) ? TIOCM_RTS: 0) /* 0x004 */
|
|
| ((msr & EDGEPORT_MSR_CTS) ? TIOCM_CTS: 0) /* 0x020 */
|
|
| ((msr & EDGEPORT_MSR_CD) ? TIOCM_CAR: 0) /* 0x040 */
|
|
| ((msr & EDGEPORT_MSR_RI) ? TIOCM_RI: 0) /* 0x080 */
|
|
| ((msr & EDGEPORT_MSR_DSR) ? TIOCM_DSR: 0); /* 0x100 */
|
|
|
|
|
|
dbg("%s -- %x", __FUNCTION__, result);
|
|
|
|
return result;
|
|
}
|
|
|
|
static int get_serial_info (struct edgeport_port *edge_port, struct serial_struct __user *retinfo)
|
|
{
|
|
struct serial_struct tmp;
|
|
|
|
if (!retinfo)
|
|
return -EFAULT;
|
|
|
|
memset(&tmp, 0, sizeof(tmp));
|
|
|
|
tmp.type = PORT_16550A;
|
|
tmp.line = edge_port->port->serial->minor;
|
|
tmp.port = edge_port->port->number;
|
|
tmp.irq = 0;
|
|
tmp.flags = ASYNC_SKIP_TEST | ASYNC_AUTO_IRQ;
|
|
tmp.xmit_fifo_size = edge_port->port->bulk_out_size;
|
|
tmp.baud_base = 9600;
|
|
tmp.close_delay = 5*HZ;
|
|
tmp.closing_wait = closing_wait;
|
|
// tmp.custom_divisor = state->custom_divisor;
|
|
// tmp.hub6 = state->hub6;
|
|
// tmp.io_type = state->io_type;
|
|
|
|
|
|
if (copy_to_user(retinfo, &tmp, sizeof(*retinfo)))
|
|
return -EFAULT;
|
|
return 0;
|
|
}
|
|
|
|
static int edge_ioctl (struct usb_serial_port *port, struct file *file, unsigned int cmd, unsigned long arg)
|
|
{
|
|
struct edgeport_port *edge_port = usb_get_serial_port_data(port);
|
|
struct async_icount cnow;
|
|
struct async_icount cprev;
|
|
|
|
dbg("%s - port %d, cmd = 0x%x", __FUNCTION__, port->number, cmd);
|
|
|
|
switch (cmd) {
|
|
case TIOCINQ:
|
|
dbg("%s - (%d) TIOCINQ", __FUNCTION__, port->number);
|
|
// return get_number_bytes_avail(edge_port, (unsigned int *) arg);
|
|
break;
|
|
|
|
case TIOCSERGETLSR:
|
|
dbg("%s - (%d) TIOCSERGETLSR", __FUNCTION__, port->number);
|
|
// return get_lsr_info(edge_port, (unsigned int *) arg);
|
|
break;
|
|
|
|
case TIOCGSERIAL:
|
|
dbg("%s - (%d) TIOCGSERIAL", __FUNCTION__, port->number);
|
|
return get_serial_info(edge_port, (struct serial_struct __user *) arg);
|
|
break;
|
|
|
|
case TIOCSSERIAL:
|
|
dbg("%s - (%d) TIOCSSERIAL", __FUNCTION__, port->number);
|
|
break;
|
|
|
|
case TIOCMIWAIT:
|
|
dbg("%s - (%d) TIOCMIWAIT", __FUNCTION__, port->number);
|
|
cprev = edge_port->icount;
|
|
while (1) {
|
|
interruptible_sleep_on(&edge_port->delta_msr_wait);
|
|
/* see if a signal did it */
|
|
if (signal_pending(current))
|
|
return -ERESTARTSYS;
|
|
cnow = edge_port->icount;
|
|
if (cnow.rng == cprev.rng && cnow.dsr == cprev.dsr &&
|
|
cnow.dcd == cprev.dcd && cnow.cts == cprev.cts)
|
|
return -EIO; /* no change => error */
|
|
if (((arg & TIOCM_RNG) && (cnow.rng != cprev.rng)) ||
|
|
((arg & TIOCM_DSR) && (cnow.dsr != cprev.dsr)) ||
|
|
((arg & TIOCM_CD) && (cnow.dcd != cprev.dcd)) ||
|
|
((arg & TIOCM_CTS) && (cnow.cts != cprev.cts)) ) {
|
|
return 0;
|
|
}
|
|
cprev = cnow;
|
|
}
|
|
/* not reached */
|
|
break;
|
|
|
|
case TIOCGICOUNT:
|
|
dbg ("%s - (%d) TIOCGICOUNT RX=%d, TX=%d", __FUNCTION__,
|
|
port->number, edge_port->icount.rx, edge_port->icount.tx);
|
|
if (copy_to_user((void __user *)arg, &edge_port->icount, sizeof(edge_port->icount)))
|
|
return -EFAULT;
|
|
return 0;
|
|
}
|
|
|
|
return -ENOIOCTLCMD;
|
|
}
|
|
|
|
static void edge_break (struct usb_serial_port *port, int break_state)
|
|
{
|
|
struct edgeport_port *edge_port = usb_get_serial_port_data(port);
|
|
int status;
|
|
|
|
dbg ("%s - state = %d", __FUNCTION__, break_state);
|
|
|
|
/* chase the port close */
|
|
TIChasePort (edge_port, 0, 0);
|
|
|
|
if (break_state == -1) {
|
|
status = TISetBreak (edge_port);
|
|
} else {
|
|
status = TIClearBreak (edge_port);
|
|
}
|
|
if (status) {
|
|
dbg ("%s - error %d sending break set/clear command.",
|
|
__FUNCTION__, status);
|
|
}
|
|
}
|
|
|
|
static int edge_startup (struct usb_serial *serial)
|
|
{
|
|
struct edgeport_serial *edge_serial;
|
|
struct edgeport_port *edge_port;
|
|
struct usb_device *dev;
|
|
int status;
|
|
int i;
|
|
|
|
dev = serial->dev;
|
|
|
|
/* create our private serial structure */
|
|
edge_serial = kzalloc(sizeof(struct edgeport_serial), GFP_KERNEL);
|
|
if (edge_serial == NULL) {
|
|
dev_err(&serial->dev->dev, "%s - Out of memory\n", __FUNCTION__);
|
|
return -ENOMEM;
|
|
}
|
|
sema_init(&edge_serial->es_sem, 1);
|
|
edge_serial->serial = serial;
|
|
usb_set_serial_data(serial, edge_serial);
|
|
|
|
status = TIDownloadFirmware (edge_serial);
|
|
if (status) {
|
|
kfree (edge_serial);
|
|
return status;
|
|
}
|
|
|
|
/* set up our port private structures */
|
|
for (i = 0; i < serial->num_ports; ++i) {
|
|
edge_port = kzalloc(sizeof(struct edgeport_port), GFP_KERNEL);
|
|
if (edge_port == NULL) {
|
|
dev_err(&serial->dev->dev, "%s - Out of memory\n", __FUNCTION__);
|
|
goto cleanup;
|
|
}
|
|
spin_lock_init(&edge_port->ep_lock);
|
|
edge_port->ep_out_buf = edge_buf_alloc(EDGE_OUT_BUF_SIZE);
|
|
if (edge_port->ep_out_buf == NULL) {
|
|
dev_err(&serial->dev->dev, "%s - Out of memory\n", __FUNCTION__);
|
|
kfree(edge_port);
|
|
goto cleanup;
|
|
}
|
|
edge_port->port = serial->port[i];
|
|
edge_port->edge_serial = edge_serial;
|
|
usb_set_serial_port_data(serial->port[i], edge_port);
|
|
edge_port->bUartMode = 0; /* Default is RS232 */
|
|
}
|
|
|
|
return 0;
|
|
|
|
cleanup:
|
|
for (--i; i>=0; --i) {
|
|
edge_port = usb_get_serial_port_data(serial->port[i]);
|
|
edge_buf_free(edge_port->ep_out_buf);
|
|
kfree(edge_port);
|
|
usb_set_serial_port_data(serial->port[i], NULL);
|
|
}
|
|
kfree (edge_serial);
|
|
usb_set_serial_data(serial, NULL);
|
|
return -ENOMEM;
|
|
}
|
|
|
|
static void edge_shutdown (struct usb_serial *serial)
|
|
{
|
|
int i;
|
|
struct edgeport_port *edge_port;
|
|
|
|
dbg ("%s", __FUNCTION__);
|
|
|
|
for (i=0; i < serial->num_ports; ++i) {
|
|
edge_port = usb_get_serial_port_data(serial->port[i]);
|
|
if (edge_port) {
|
|
edge_buf_free(edge_port->ep_out_buf);
|
|
kfree(edge_port);
|
|
}
|
|
usb_set_serial_port_data(serial->port[i], NULL);
|
|
}
|
|
kfree (usb_get_serial_data(serial));
|
|
usb_set_serial_data(serial, NULL);
|
|
}
|
|
|
|
|
|
/* Circular Buffer */
|
|
|
|
/*
|
|
* edge_buf_alloc
|
|
*
|
|
* Allocate a circular buffer and all associated memory.
|
|
*/
|
|
|
|
static struct edge_buf *edge_buf_alloc(unsigned int size)
|
|
{
|
|
struct edge_buf *eb;
|
|
|
|
|
|
if (size == 0)
|
|
return NULL;
|
|
|
|
eb = (struct edge_buf *)kmalloc(sizeof(struct edge_buf), GFP_KERNEL);
|
|
if (eb == NULL)
|
|
return NULL;
|
|
|
|
eb->buf_buf = kmalloc(size, GFP_KERNEL);
|
|
if (eb->buf_buf == NULL) {
|
|
kfree(eb);
|
|
return NULL;
|
|
}
|
|
|
|
eb->buf_size = size;
|
|
eb->buf_get = eb->buf_put = eb->buf_buf;
|
|
|
|
return eb;
|
|
}
|
|
|
|
|
|
/*
|
|
* edge_buf_free
|
|
*
|
|
* Free the buffer and all associated memory.
|
|
*/
|
|
|
|
static void edge_buf_free(struct edge_buf *eb)
|
|
{
|
|
if (eb) {
|
|
kfree(eb->buf_buf);
|
|
kfree(eb);
|
|
}
|
|
}
|
|
|
|
|
|
/*
|
|
* edge_buf_clear
|
|
*
|
|
* Clear out all data in the circular buffer.
|
|
*/
|
|
|
|
static void edge_buf_clear(struct edge_buf *eb)
|
|
{
|
|
if (eb != NULL)
|
|
eb->buf_get = eb->buf_put;
|
|
/* equivalent to a get of all data available */
|
|
}
|
|
|
|
|
|
/*
|
|
* edge_buf_data_avail
|
|
*
|
|
* Return the number of bytes of data available in the circular
|
|
* buffer.
|
|
*/
|
|
|
|
static unsigned int edge_buf_data_avail(struct edge_buf *eb)
|
|
{
|
|
if (eb != NULL)
|
|
return ((eb->buf_size + eb->buf_put - eb->buf_get) % eb->buf_size);
|
|
else
|
|
return 0;
|
|
}
|
|
|
|
|
|
/*
|
|
* edge_buf_space_avail
|
|
*
|
|
* Return the number of bytes of space available in the circular
|
|
* buffer.
|
|
*/
|
|
|
|
static unsigned int edge_buf_space_avail(struct edge_buf *eb)
|
|
{
|
|
if (eb != NULL)
|
|
return ((eb->buf_size + eb->buf_get - eb->buf_put - 1) % eb->buf_size);
|
|
else
|
|
return 0;
|
|
}
|
|
|
|
|
|
/*
|
|
* edge_buf_put
|
|
*
|
|
* Copy data data from a user buffer and put it into the circular buffer.
|
|
* Restrict to the amount of space available.
|
|
*
|
|
* Return the number of bytes copied.
|
|
*/
|
|
|
|
static unsigned int edge_buf_put(struct edge_buf *eb, const char *buf,
|
|
unsigned int count)
|
|
{
|
|
unsigned int len;
|
|
|
|
|
|
if (eb == NULL)
|
|
return 0;
|
|
|
|
len = edge_buf_space_avail(eb);
|
|
if (count > len)
|
|
count = len;
|
|
|
|
if (count == 0)
|
|
return 0;
|
|
|
|
len = eb->buf_buf + eb->buf_size - eb->buf_put;
|
|
if (count > len) {
|
|
memcpy(eb->buf_put, buf, len);
|
|
memcpy(eb->buf_buf, buf+len, count - len);
|
|
eb->buf_put = eb->buf_buf + count - len;
|
|
} else {
|
|
memcpy(eb->buf_put, buf, count);
|
|
if (count < len)
|
|
eb->buf_put += count;
|
|
else /* count == len */
|
|
eb->buf_put = eb->buf_buf;
|
|
}
|
|
|
|
return count;
|
|
}
|
|
|
|
|
|
/*
|
|
* edge_buf_get
|
|
*
|
|
* Get data from the circular buffer and copy to the given buffer.
|
|
* Restrict to the amount of data available.
|
|
*
|
|
* Return the number of bytes copied.
|
|
*/
|
|
|
|
static unsigned int edge_buf_get(struct edge_buf *eb, char *buf,
|
|
unsigned int count)
|
|
{
|
|
unsigned int len;
|
|
|
|
|
|
if (eb == NULL)
|
|
return 0;
|
|
|
|
len = edge_buf_data_avail(eb);
|
|
if (count > len)
|
|
count = len;
|
|
|
|
if (count == 0)
|
|
return 0;
|
|
|
|
len = eb->buf_buf + eb->buf_size - eb->buf_get;
|
|
if (count > len) {
|
|
memcpy(buf, eb->buf_get, len);
|
|
memcpy(buf+len, eb->buf_buf, count - len);
|
|
eb->buf_get = eb->buf_buf + count - len;
|
|
} else {
|
|
memcpy(buf, eb->buf_get, count);
|
|
if (count < len)
|
|
eb->buf_get += count;
|
|
else /* count == len */
|
|
eb->buf_get = eb->buf_buf;
|
|
}
|
|
|
|
return count;
|
|
}
|
|
|
|
|
|
static struct usb_serial_driver edgeport_1port_device = {
|
|
.driver = {
|
|
.owner = THIS_MODULE,
|
|
.name = "edgeport_ti_1",
|
|
},
|
|
.description = "Edgeport TI 1 port adapter",
|
|
.id_table = edgeport_1port_id_table,
|
|
.num_interrupt_in = 1,
|
|
.num_bulk_in = 1,
|
|
.num_bulk_out = 1,
|
|
.num_ports = 1,
|
|
.open = edge_open,
|
|
.close = edge_close,
|
|
.throttle = edge_throttle,
|
|
.unthrottle = edge_unthrottle,
|
|
.attach = edge_startup,
|
|
.shutdown = edge_shutdown,
|
|
.ioctl = edge_ioctl,
|
|
.set_termios = edge_set_termios,
|
|
.tiocmget = edge_tiocmget,
|
|
.tiocmset = edge_tiocmset,
|
|
.write = edge_write,
|
|
.write_room = edge_write_room,
|
|
.chars_in_buffer = edge_chars_in_buffer,
|
|
.break_ctl = edge_break,
|
|
.read_int_callback = edge_interrupt_callback,
|
|
.read_bulk_callback = edge_bulk_in_callback,
|
|
.write_bulk_callback = edge_bulk_out_callback,
|
|
};
|
|
|
|
static struct usb_serial_driver edgeport_2port_device = {
|
|
.driver = {
|
|
.owner = THIS_MODULE,
|
|
.name = "edgeport_ti_2",
|
|
},
|
|
.description = "Edgeport TI 2 port adapter",
|
|
.id_table = edgeport_2port_id_table,
|
|
.num_interrupt_in = 1,
|
|
.num_bulk_in = 2,
|
|
.num_bulk_out = 2,
|
|
.num_ports = 2,
|
|
.open = edge_open,
|
|
.close = edge_close,
|
|
.throttle = edge_throttle,
|
|
.unthrottle = edge_unthrottle,
|
|
.attach = edge_startup,
|
|
.shutdown = edge_shutdown,
|
|
.ioctl = edge_ioctl,
|
|
.set_termios = edge_set_termios,
|
|
.tiocmget = edge_tiocmget,
|
|
.tiocmset = edge_tiocmset,
|
|
.write = edge_write,
|
|
.write_room = edge_write_room,
|
|
.chars_in_buffer = edge_chars_in_buffer,
|
|
.break_ctl = edge_break,
|
|
.read_int_callback = edge_interrupt_callback,
|
|
.read_bulk_callback = edge_bulk_in_callback,
|
|
.write_bulk_callback = edge_bulk_out_callback,
|
|
};
|
|
|
|
|
|
static int __init edgeport_init(void)
|
|
{
|
|
int retval;
|
|
retval = usb_serial_register(&edgeport_1port_device);
|
|
if (retval)
|
|
goto failed_1port_device_register;
|
|
retval = usb_serial_register(&edgeport_2port_device);
|
|
if (retval)
|
|
goto failed_2port_device_register;
|
|
retval = usb_register(&io_driver);
|
|
if (retval)
|
|
goto failed_usb_register;
|
|
info(DRIVER_DESC " " DRIVER_VERSION);
|
|
return 0;
|
|
failed_usb_register:
|
|
usb_serial_deregister(&edgeport_2port_device);
|
|
failed_2port_device_register:
|
|
usb_serial_deregister(&edgeport_1port_device);
|
|
failed_1port_device_register:
|
|
return retval;
|
|
}
|
|
|
|
static void __exit edgeport_exit (void)
|
|
{
|
|
usb_deregister (&io_driver);
|
|
usb_serial_deregister (&edgeport_1port_device);
|
|
usb_serial_deregister (&edgeport_2port_device);
|
|
}
|
|
|
|
module_init(edgeport_init);
|
|
module_exit(edgeport_exit);
|
|
|
|
/* Module information */
|
|
MODULE_AUTHOR(DRIVER_AUTHOR);
|
|
MODULE_DESCRIPTION(DRIVER_DESC);
|
|
MODULE_LICENSE("GPL");
|
|
|
|
module_param(debug, bool, S_IRUGO | S_IWUSR);
|
|
MODULE_PARM_DESC(debug, "Debug enabled or not");
|
|
|
|
module_param(low_latency, bool, S_IRUGO | S_IWUSR);
|
|
MODULE_PARM_DESC(low_latency, "Low latency enabled or not");
|
|
|
|
module_param(closing_wait, int, S_IRUGO | S_IWUSR);
|
|
MODULE_PARM_DESC(closing_wait, "Maximum wait for data to drain, in .01 secs");
|
|
|
|
module_param(ignore_cpu_rev, bool, S_IRUGO | S_IWUSR);
|
|
MODULE_PARM_DESC(ignore_cpu_rev, "Ignore the cpu revision when connecting to a device");
|
|
|