forked from Minki/linux
eece09ec21
The static lock initializers want to be fed the proper name of the lock and not some random string. In mainline random strings are obfuscating the readability of debug output, but for RT they prevent the spinlock substitution. Fix it up. Signed-off-by: Thomas Gleixner <tglx@linutronix.de>
802 lines
19 KiB
C
802 lines
19 KiB
C
#include <linux/delay.h>
|
|
#include <linux/device.h>
|
|
#include <linux/dmapool.h>
|
|
#include <linux/dma-mapping.h>
|
|
#include <linux/init.h>
|
|
#include <linux/platform_device.h>
|
|
#include <linux/module.h>
|
|
#include <linux/interrupt.h>
|
|
#include <linux/io.h>
|
|
#include <linux/irq.h>
|
|
#include <linux/kernel.h>
|
|
#include <linux/slab.h>
|
|
#include <linux/pm_runtime.h>
|
|
#include <linux/usb/ch9.h>
|
|
#include <linux/usb/gadget.h>
|
|
#include <linux/usb/otg.h>
|
|
#include <linux/usb/chipidea.h>
|
|
|
|
#include "ci.h"
|
|
#include "udc.h"
|
|
#include "bits.h"
|
|
#include "debug.h"
|
|
|
|
/* Interrupt statistics */
|
|
#define ISR_MASK 0x1F
|
|
static struct isr_statistics {
|
|
u32 test;
|
|
u32 ui;
|
|
u32 uei;
|
|
u32 pci;
|
|
u32 uri;
|
|
u32 sli;
|
|
u32 none;
|
|
struct {
|
|
u32 cnt;
|
|
u32 buf[ISR_MASK+1];
|
|
u32 idx;
|
|
} hndl;
|
|
} isr_statistics;
|
|
|
|
void dbg_interrupt(u32 intmask)
|
|
{
|
|
if (!intmask) {
|
|
isr_statistics.none++;
|
|
return;
|
|
}
|
|
|
|
isr_statistics.hndl.buf[isr_statistics.hndl.idx++] = intmask;
|
|
isr_statistics.hndl.idx &= ISR_MASK;
|
|
isr_statistics.hndl.cnt++;
|
|
|
|
if (USBi_URI & intmask)
|
|
isr_statistics.uri++;
|
|
if (USBi_PCI & intmask)
|
|
isr_statistics.pci++;
|
|
if (USBi_UEI & intmask)
|
|
isr_statistics.uei++;
|
|
if (USBi_UI & intmask)
|
|
isr_statistics.ui++;
|
|
if (USBi_SLI & intmask)
|
|
isr_statistics.sli++;
|
|
}
|
|
|
|
/**
|
|
* hw_register_read: reads all device registers (execute without interruption)
|
|
* @buf: destination buffer
|
|
* @size: buffer size
|
|
*
|
|
* This function returns number of registers read
|
|
*/
|
|
static size_t hw_register_read(struct ci13xxx *ci, u32 *buf, size_t size)
|
|
{
|
|
unsigned i;
|
|
|
|
if (size > ci->hw_bank.size)
|
|
size = ci->hw_bank.size;
|
|
|
|
for (i = 0; i < size; i++)
|
|
buf[i] = hw_read(ci, i * sizeof(u32), ~0);
|
|
|
|
return size;
|
|
}
|
|
|
|
/**
|
|
* hw_register_write: writes to register
|
|
* @addr: register address
|
|
* @data: register value
|
|
*
|
|
* This function returns an error code
|
|
*/
|
|
static int hw_register_write(struct ci13xxx *ci, u16 addr, u32 data)
|
|
{
|
|
/* align */
|
|
addr /= sizeof(u32);
|
|
|
|
if (addr >= ci->hw_bank.size)
|
|
return -EINVAL;
|
|
|
|
/* align */
|
|
addr *= sizeof(u32);
|
|
|
|
hw_write(ci, addr, ~0, data);
|
|
return 0;
|
|
}
|
|
|
|
/**
|
|
* hw_intr_clear: disables interrupt & clears interrupt status (execute without
|
|
* interruption)
|
|
* @n: interrupt bit
|
|
*
|
|
* This function returns an error code
|
|
*/
|
|
static int hw_intr_clear(struct ci13xxx *ci, int n)
|
|
{
|
|
if (n >= REG_BITS)
|
|
return -EINVAL;
|
|
|
|
hw_write(ci, OP_USBINTR, BIT(n), 0);
|
|
hw_write(ci, OP_USBSTS, BIT(n), BIT(n));
|
|
return 0;
|
|
}
|
|
|
|
/**
|
|
* hw_intr_force: enables interrupt & forces interrupt status (execute without
|
|
* interruption)
|
|
* @n: interrupt bit
|
|
*
|
|
* This function returns an error code
|
|
*/
|
|
static int hw_intr_force(struct ci13xxx *ci, int n)
|
|
{
|
|
if (n >= REG_BITS)
|
|
return -EINVAL;
|
|
|
|
hw_write(ci, CAP_TESTMODE, TESTMODE_FORCE, TESTMODE_FORCE);
|
|
hw_write(ci, OP_USBINTR, BIT(n), BIT(n));
|
|
hw_write(ci, OP_USBSTS, BIT(n), BIT(n));
|
|
hw_write(ci, CAP_TESTMODE, TESTMODE_FORCE, 0);
|
|
return 0;
|
|
}
|
|
|
|
/**
|
|
* show_device: prints information about device capabilities and status
|
|
*
|
|
* Check "device.h" for details
|
|
*/
|
|
static ssize_t show_device(struct device *dev, struct device_attribute *attr,
|
|
char *buf)
|
|
{
|
|
struct ci13xxx *ci = container_of(dev, struct ci13xxx, gadget.dev);
|
|
struct usb_gadget *gadget = &ci->gadget;
|
|
int n = 0;
|
|
|
|
if (attr == NULL || buf == NULL) {
|
|
dev_err(ci->dev, "[%s] EINVAL\n", __func__);
|
|
return 0;
|
|
}
|
|
|
|
n += scnprintf(buf + n, PAGE_SIZE - n, "speed = %d\n",
|
|
gadget->speed);
|
|
n += scnprintf(buf + n, PAGE_SIZE - n, "max_speed = %d\n",
|
|
gadget->max_speed);
|
|
n += scnprintf(buf + n, PAGE_SIZE - n, "is_otg = %d\n",
|
|
gadget->is_otg);
|
|
n += scnprintf(buf + n, PAGE_SIZE - n, "is_a_peripheral = %d\n",
|
|
gadget->is_a_peripheral);
|
|
n += scnprintf(buf + n, PAGE_SIZE - n, "b_hnp_enable = %d\n",
|
|
gadget->b_hnp_enable);
|
|
n += scnprintf(buf + n, PAGE_SIZE - n, "a_hnp_support = %d\n",
|
|
gadget->a_hnp_support);
|
|
n += scnprintf(buf + n, PAGE_SIZE - n, "a_alt_hnp_support = %d\n",
|
|
gadget->a_alt_hnp_support);
|
|
n += scnprintf(buf + n, PAGE_SIZE - n, "name = %s\n",
|
|
(gadget->name ? gadget->name : ""));
|
|
|
|
return n;
|
|
}
|
|
static DEVICE_ATTR(device, S_IRUSR, show_device, NULL);
|
|
|
|
/**
|
|
* show_driver: prints information about attached gadget (if any)
|
|
*
|
|
* Check "device.h" for details
|
|
*/
|
|
static ssize_t show_driver(struct device *dev, struct device_attribute *attr,
|
|
char *buf)
|
|
{
|
|
struct ci13xxx *ci = container_of(dev, struct ci13xxx, gadget.dev);
|
|
struct usb_gadget_driver *driver = ci->driver;
|
|
int n = 0;
|
|
|
|
if (attr == NULL || buf == NULL) {
|
|
dev_err(dev, "[%s] EINVAL\n", __func__);
|
|
return 0;
|
|
}
|
|
|
|
if (driver == NULL)
|
|
return scnprintf(buf, PAGE_SIZE,
|
|
"There is no gadget attached!\n");
|
|
|
|
n += scnprintf(buf + n, PAGE_SIZE - n, "function = %s\n",
|
|
(driver->function ? driver->function : ""));
|
|
n += scnprintf(buf + n, PAGE_SIZE - n, "max speed = %d\n",
|
|
driver->max_speed);
|
|
|
|
return n;
|
|
}
|
|
static DEVICE_ATTR(driver, S_IRUSR, show_driver, NULL);
|
|
|
|
/* Maximum event message length */
|
|
#define DBG_DATA_MSG 64UL
|
|
|
|
/* Maximum event messages */
|
|
#define DBG_DATA_MAX 128UL
|
|
|
|
/* Event buffer descriptor */
|
|
static struct {
|
|
char (buf[DBG_DATA_MAX])[DBG_DATA_MSG]; /* buffer */
|
|
unsigned idx; /* index */
|
|
unsigned tty; /* print to console? */
|
|
rwlock_t lck; /* lock */
|
|
} dbg_data = {
|
|
.idx = 0,
|
|
.tty = 0,
|
|
.lck = __RW_LOCK_UNLOCKED(dbg_data.lck)
|
|
};
|
|
|
|
/**
|
|
* dbg_dec: decrements debug event index
|
|
* @idx: buffer index
|
|
*/
|
|
static void dbg_dec(unsigned *idx)
|
|
{
|
|
*idx = (*idx - 1) & (DBG_DATA_MAX-1);
|
|
}
|
|
|
|
/**
|
|
* dbg_inc: increments debug event index
|
|
* @idx: buffer index
|
|
*/
|
|
static void dbg_inc(unsigned *idx)
|
|
{
|
|
*idx = (*idx + 1) & (DBG_DATA_MAX-1);
|
|
}
|
|
|
|
/**
|
|
* dbg_print: prints the common part of the event
|
|
* @addr: endpoint address
|
|
* @name: event name
|
|
* @status: status
|
|
* @extra: extra information
|
|
*/
|
|
static void dbg_print(u8 addr, const char *name, int status, const char *extra)
|
|
{
|
|
struct timeval tval;
|
|
unsigned int stamp;
|
|
unsigned long flags;
|
|
|
|
write_lock_irqsave(&dbg_data.lck, flags);
|
|
|
|
do_gettimeofday(&tval);
|
|
stamp = tval.tv_sec & 0xFFFF; /* 2^32 = 4294967296. Limit to 4096s */
|
|
stamp = stamp * 1000000 + tval.tv_usec;
|
|
|
|
scnprintf(dbg_data.buf[dbg_data.idx], DBG_DATA_MSG,
|
|
"%04X\t? %02X %-7.7s %4i ?\t%s\n",
|
|
stamp, addr, name, status, extra);
|
|
|
|
dbg_inc(&dbg_data.idx);
|
|
|
|
write_unlock_irqrestore(&dbg_data.lck, flags);
|
|
|
|
if (dbg_data.tty != 0)
|
|
pr_notice("%04X\t? %02X %-7.7s %4i ?\t%s\n",
|
|
stamp, addr, name, status, extra);
|
|
}
|
|
|
|
/**
|
|
* dbg_done: prints a DONE event
|
|
* @addr: endpoint address
|
|
* @td: transfer descriptor
|
|
* @status: status
|
|
*/
|
|
void dbg_done(u8 addr, const u32 token, int status)
|
|
{
|
|
char msg[DBG_DATA_MSG];
|
|
|
|
scnprintf(msg, sizeof(msg), "%d %02X",
|
|
(int)(token & TD_TOTAL_BYTES) >> ffs_nr(TD_TOTAL_BYTES),
|
|
(int)(token & TD_STATUS) >> ffs_nr(TD_STATUS));
|
|
dbg_print(addr, "DONE", status, msg);
|
|
}
|
|
|
|
/**
|
|
* dbg_event: prints a generic event
|
|
* @addr: endpoint address
|
|
* @name: event name
|
|
* @status: status
|
|
*/
|
|
void dbg_event(u8 addr, const char *name, int status)
|
|
{
|
|
if (name != NULL)
|
|
dbg_print(addr, name, status, "");
|
|
}
|
|
|
|
/*
|
|
* dbg_queue: prints a QUEUE event
|
|
* @addr: endpoint address
|
|
* @req: USB request
|
|
* @status: status
|
|
*/
|
|
void dbg_queue(u8 addr, const struct usb_request *req, int status)
|
|
{
|
|
char msg[DBG_DATA_MSG];
|
|
|
|
if (req != NULL) {
|
|
scnprintf(msg, sizeof(msg),
|
|
"%d %d", !req->no_interrupt, req->length);
|
|
dbg_print(addr, "QUEUE", status, msg);
|
|
}
|
|
}
|
|
|
|
/**
|
|
* dbg_setup: prints a SETUP event
|
|
* @addr: endpoint address
|
|
* @req: setup request
|
|
*/
|
|
void dbg_setup(u8 addr, const struct usb_ctrlrequest *req)
|
|
{
|
|
char msg[DBG_DATA_MSG];
|
|
|
|
if (req != NULL) {
|
|
scnprintf(msg, sizeof(msg),
|
|
"%02X %02X %04X %04X %d", req->bRequestType,
|
|
req->bRequest, le16_to_cpu(req->wValue),
|
|
le16_to_cpu(req->wIndex), le16_to_cpu(req->wLength));
|
|
dbg_print(addr, "SETUP", 0, msg);
|
|
}
|
|
}
|
|
|
|
/**
|
|
* show_events: displays the event buffer
|
|
*
|
|
* Check "device.h" for details
|
|
*/
|
|
static ssize_t show_events(struct device *dev, struct device_attribute *attr,
|
|
char *buf)
|
|
{
|
|
unsigned long flags;
|
|
unsigned i, j, n = 0;
|
|
|
|
if (attr == NULL || buf == NULL) {
|
|
dev_err(dev->parent, "[%s] EINVAL\n", __func__);
|
|
return 0;
|
|
}
|
|
|
|
read_lock_irqsave(&dbg_data.lck, flags);
|
|
|
|
i = dbg_data.idx;
|
|
for (dbg_dec(&i); i != dbg_data.idx; dbg_dec(&i)) {
|
|
n += strlen(dbg_data.buf[i]);
|
|
if (n >= PAGE_SIZE) {
|
|
n -= strlen(dbg_data.buf[i]);
|
|
break;
|
|
}
|
|
}
|
|
for (j = 0, dbg_inc(&i); j < n; dbg_inc(&i))
|
|
j += scnprintf(buf + j, PAGE_SIZE - j,
|
|
"%s", dbg_data.buf[i]);
|
|
|
|
read_unlock_irqrestore(&dbg_data.lck, flags);
|
|
|
|
return n;
|
|
}
|
|
|
|
/**
|
|
* store_events: configure if events are going to be also printed to console
|
|
*
|
|
* Check "device.h" for details
|
|
*/
|
|
static ssize_t store_events(struct device *dev, struct device_attribute *attr,
|
|
const char *buf, size_t count)
|
|
{
|
|
unsigned tty;
|
|
|
|
if (attr == NULL || buf == NULL) {
|
|
dev_err(dev, "[%s] EINVAL\n", __func__);
|
|
goto done;
|
|
}
|
|
|
|
if (sscanf(buf, "%u", &tty) != 1 || tty > 1) {
|
|
dev_err(dev, "<1|0>: enable|disable console log\n");
|
|
goto done;
|
|
}
|
|
|
|
dbg_data.tty = tty;
|
|
dev_info(dev, "tty = %u", dbg_data.tty);
|
|
|
|
done:
|
|
return count;
|
|
}
|
|
static DEVICE_ATTR(events, S_IRUSR | S_IWUSR, show_events, store_events);
|
|
|
|
/**
|
|
* show_inters: interrupt status, enable status and historic
|
|
*
|
|
* Check "device.h" for details
|
|
*/
|
|
static ssize_t show_inters(struct device *dev, struct device_attribute *attr,
|
|
char *buf)
|
|
{
|
|
struct ci13xxx *ci = container_of(dev, struct ci13xxx, gadget.dev);
|
|
unsigned long flags;
|
|
u32 intr;
|
|
unsigned i, j, n = 0;
|
|
|
|
if (attr == NULL || buf == NULL) {
|
|
dev_err(ci->dev, "[%s] EINVAL\n", __func__);
|
|
return 0;
|
|
}
|
|
|
|
spin_lock_irqsave(&ci->lock, flags);
|
|
|
|
/*n += scnprintf(buf + n, PAGE_SIZE - n,
|
|
"status = %08x\n", hw_read_intr_status(ci));
|
|
n += scnprintf(buf + n, PAGE_SIZE - n,
|
|
"enable = %08x\n", hw_read_intr_enable(ci));*/
|
|
|
|
n += scnprintf(buf + n, PAGE_SIZE - n, "*test = %d\n",
|
|
isr_statistics.test);
|
|
n += scnprintf(buf + n, PAGE_SIZE - n, "? ui = %d\n",
|
|
isr_statistics.ui);
|
|
n += scnprintf(buf + n, PAGE_SIZE - n, "? uei = %d\n",
|
|
isr_statistics.uei);
|
|
n += scnprintf(buf + n, PAGE_SIZE - n, "? pci = %d\n",
|
|
isr_statistics.pci);
|
|
n += scnprintf(buf + n, PAGE_SIZE - n, "? uri = %d\n",
|
|
isr_statistics.uri);
|
|
n += scnprintf(buf + n, PAGE_SIZE - n, "? sli = %d\n",
|
|
isr_statistics.sli);
|
|
n += scnprintf(buf + n, PAGE_SIZE - n, "*none = %d\n",
|
|
isr_statistics.none);
|
|
n += scnprintf(buf + n, PAGE_SIZE - n, "*hndl = %d\n",
|
|
isr_statistics.hndl.cnt);
|
|
|
|
for (i = isr_statistics.hndl.idx, j = 0; j <= ISR_MASK; j++, i++) {
|
|
i &= ISR_MASK;
|
|
intr = isr_statistics.hndl.buf[i];
|
|
|
|
if (USBi_UI & intr)
|
|
n += scnprintf(buf + n, PAGE_SIZE - n, "ui ");
|
|
intr &= ~USBi_UI;
|
|
if (USBi_UEI & intr)
|
|
n += scnprintf(buf + n, PAGE_SIZE - n, "uei ");
|
|
intr &= ~USBi_UEI;
|
|
if (USBi_PCI & intr)
|
|
n += scnprintf(buf + n, PAGE_SIZE - n, "pci ");
|
|
intr &= ~USBi_PCI;
|
|
if (USBi_URI & intr)
|
|
n += scnprintf(buf + n, PAGE_SIZE - n, "uri ");
|
|
intr &= ~USBi_URI;
|
|
if (USBi_SLI & intr)
|
|
n += scnprintf(buf + n, PAGE_SIZE - n, "sli ");
|
|
intr &= ~USBi_SLI;
|
|
if (intr)
|
|
n += scnprintf(buf + n, PAGE_SIZE - n, "??? ");
|
|
if (isr_statistics.hndl.buf[i])
|
|
n += scnprintf(buf + n, PAGE_SIZE - n, "\n");
|
|
}
|
|
|
|
spin_unlock_irqrestore(&ci->lock, flags);
|
|
|
|
return n;
|
|
}
|
|
|
|
/**
|
|
* store_inters: enable & force or disable an individual interrutps
|
|
* (to be used for test purposes only)
|
|
*
|
|
* Check "device.h" for details
|
|
*/
|
|
static ssize_t store_inters(struct device *dev, struct device_attribute *attr,
|
|
const char *buf, size_t count)
|
|
{
|
|
struct ci13xxx *ci = container_of(dev, struct ci13xxx, gadget.dev);
|
|
unsigned long flags;
|
|
unsigned en, bit;
|
|
|
|
if (attr == NULL || buf == NULL) {
|
|
dev_err(ci->dev, "EINVAL\n");
|
|
goto done;
|
|
}
|
|
|
|
if (sscanf(buf, "%u %u", &en, &bit) != 2 || en > 1) {
|
|
dev_err(ci->dev, "<1|0> <bit>: enable|disable interrupt\n");
|
|
goto done;
|
|
}
|
|
|
|
spin_lock_irqsave(&ci->lock, flags);
|
|
if (en) {
|
|
if (hw_intr_force(ci, bit))
|
|
dev_err(dev, "invalid bit number\n");
|
|
else
|
|
isr_statistics.test++;
|
|
} else {
|
|
if (hw_intr_clear(ci, bit))
|
|
dev_err(dev, "invalid bit number\n");
|
|
}
|
|
spin_unlock_irqrestore(&ci->lock, flags);
|
|
|
|
done:
|
|
return count;
|
|
}
|
|
static DEVICE_ATTR(inters, S_IRUSR | S_IWUSR, show_inters, store_inters);
|
|
|
|
/**
|
|
* show_port_test: reads port test mode
|
|
*
|
|
* Check "device.h" for details
|
|
*/
|
|
static ssize_t show_port_test(struct device *dev,
|
|
struct device_attribute *attr, char *buf)
|
|
{
|
|
struct ci13xxx *ci = container_of(dev, struct ci13xxx, gadget.dev);
|
|
unsigned long flags;
|
|
unsigned mode;
|
|
|
|
if (attr == NULL || buf == NULL) {
|
|
dev_err(ci->dev, "EINVAL\n");
|
|
return 0;
|
|
}
|
|
|
|
spin_lock_irqsave(&ci->lock, flags);
|
|
mode = hw_port_test_get(ci);
|
|
spin_unlock_irqrestore(&ci->lock, flags);
|
|
|
|
return scnprintf(buf, PAGE_SIZE, "mode = %u\n", mode);
|
|
}
|
|
|
|
/**
|
|
* store_port_test: writes port test mode
|
|
*
|
|
* Check "device.h" for details
|
|
*/
|
|
static ssize_t store_port_test(struct device *dev,
|
|
struct device_attribute *attr,
|
|
const char *buf, size_t count)
|
|
{
|
|
struct ci13xxx *ci = container_of(dev, struct ci13xxx, gadget.dev);
|
|
unsigned long flags;
|
|
unsigned mode;
|
|
|
|
if (attr == NULL || buf == NULL) {
|
|
dev_err(ci->dev, "[%s] EINVAL\n", __func__);
|
|
goto done;
|
|
}
|
|
|
|
if (sscanf(buf, "%u", &mode) != 1) {
|
|
dev_err(ci->dev, "<mode>: set port test mode");
|
|
goto done;
|
|
}
|
|
|
|
spin_lock_irqsave(&ci->lock, flags);
|
|
if (hw_port_test_set(ci, mode))
|
|
dev_err(ci->dev, "invalid mode\n");
|
|
spin_unlock_irqrestore(&ci->lock, flags);
|
|
|
|
done:
|
|
return count;
|
|
}
|
|
static DEVICE_ATTR(port_test, S_IRUSR | S_IWUSR,
|
|
show_port_test, store_port_test);
|
|
|
|
/**
|
|
* show_qheads: DMA contents of all queue heads
|
|
*
|
|
* Check "device.h" for details
|
|
*/
|
|
static ssize_t show_qheads(struct device *dev, struct device_attribute *attr,
|
|
char *buf)
|
|
{
|
|
struct ci13xxx *ci = container_of(dev, struct ci13xxx, gadget.dev);
|
|
unsigned long flags;
|
|
unsigned i, j, n = 0;
|
|
|
|
if (attr == NULL || buf == NULL) {
|
|
dev_err(ci->dev, "[%s] EINVAL\n", __func__);
|
|
return 0;
|
|
}
|
|
|
|
spin_lock_irqsave(&ci->lock, flags);
|
|
for (i = 0; i < ci->hw_ep_max/2; i++) {
|
|
struct ci13xxx_ep *mEpRx = &ci->ci13xxx_ep[i];
|
|
struct ci13xxx_ep *mEpTx =
|
|
&ci->ci13xxx_ep[i + ci->hw_ep_max/2];
|
|
n += scnprintf(buf + n, PAGE_SIZE - n,
|
|
"EP=%02i: RX=%08X TX=%08X\n",
|
|
i, (u32)mEpRx->qh.dma, (u32)mEpTx->qh.dma);
|
|
for (j = 0; j < (sizeof(struct ci13xxx_qh)/sizeof(u32)); j++) {
|
|
n += scnprintf(buf + n, PAGE_SIZE - n,
|
|
" %04X: %08X %08X\n", j,
|
|
*((u32 *)mEpRx->qh.ptr + j),
|
|
*((u32 *)mEpTx->qh.ptr + j));
|
|
}
|
|
}
|
|
spin_unlock_irqrestore(&ci->lock, flags);
|
|
|
|
return n;
|
|
}
|
|
static DEVICE_ATTR(qheads, S_IRUSR, show_qheads, NULL);
|
|
|
|
/**
|
|
* show_registers: dumps all registers
|
|
*
|
|
* Check "device.h" for details
|
|
*/
|
|
#define DUMP_ENTRIES 512
|
|
static ssize_t show_registers(struct device *dev,
|
|
struct device_attribute *attr, char *buf)
|
|
{
|
|
struct ci13xxx *ci = container_of(dev, struct ci13xxx, gadget.dev);
|
|
unsigned long flags;
|
|
u32 *dump;
|
|
unsigned i, k, n = 0;
|
|
|
|
if (attr == NULL || buf == NULL) {
|
|
dev_err(ci->dev, "[%s] EINVAL\n", __func__);
|
|
return 0;
|
|
}
|
|
|
|
dump = kmalloc(sizeof(u32) * DUMP_ENTRIES, GFP_KERNEL);
|
|
if (!dump) {
|
|
dev_err(ci->dev, "%s: out of memory\n", __func__);
|
|
return 0;
|
|
}
|
|
|
|
spin_lock_irqsave(&ci->lock, flags);
|
|
k = hw_register_read(ci, dump, DUMP_ENTRIES);
|
|
spin_unlock_irqrestore(&ci->lock, flags);
|
|
|
|
for (i = 0; i < k; i++) {
|
|
n += scnprintf(buf + n, PAGE_SIZE - n,
|
|
"reg[0x%04X] = 0x%08X\n",
|
|
i * (unsigned)sizeof(u32), dump[i]);
|
|
}
|
|
kfree(dump);
|
|
|
|
return n;
|
|
}
|
|
|
|
/**
|
|
* store_registers: writes value to register address
|
|
*
|
|
* Check "device.h" for details
|
|
*/
|
|
static ssize_t store_registers(struct device *dev,
|
|
struct device_attribute *attr,
|
|
const char *buf, size_t count)
|
|
{
|
|
struct ci13xxx *ci = container_of(dev, struct ci13xxx, gadget.dev);
|
|
unsigned long addr, data, flags;
|
|
|
|
if (attr == NULL || buf == NULL) {
|
|
dev_err(ci->dev, "[%s] EINVAL\n", __func__);
|
|
goto done;
|
|
}
|
|
|
|
if (sscanf(buf, "%li %li", &addr, &data) != 2) {
|
|
dev_err(ci->dev,
|
|
"<addr> <data>: write data to register address\n");
|
|
goto done;
|
|
}
|
|
|
|
spin_lock_irqsave(&ci->lock, flags);
|
|
if (hw_register_write(ci, addr, data))
|
|
dev_err(ci->dev, "invalid address range\n");
|
|
spin_unlock_irqrestore(&ci->lock, flags);
|
|
|
|
done:
|
|
return count;
|
|
}
|
|
static DEVICE_ATTR(registers, S_IRUSR | S_IWUSR,
|
|
show_registers, store_registers);
|
|
|
|
/**
|
|
* show_requests: DMA contents of all requests currently queued (all endpts)
|
|
*
|
|
* Check "device.h" for details
|
|
*/
|
|
static ssize_t show_requests(struct device *dev, struct device_attribute *attr,
|
|
char *buf)
|
|
{
|
|
struct ci13xxx *ci = container_of(dev, struct ci13xxx, gadget.dev);
|
|
unsigned long flags;
|
|
struct list_head *ptr = NULL;
|
|
struct ci13xxx_req *req = NULL;
|
|
unsigned i, j, n = 0, qSize = sizeof(struct ci13xxx_td)/sizeof(u32);
|
|
|
|
if (attr == NULL || buf == NULL) {
|
|
dev_err(ci->dev, "[%s] EINVAL\n", __func__);
|
|
return 0;
|
|
}
|
|
|
|
spin_lock_irqsave(&ci->lock, flags);
|
|
for (i = 0; i < ci->hw_ep_max; i++)
|
|
list_for_each(ptr, &ci->ci13xxx_ep[i].qh.queue)
|
|
{
|
|
req = list_entry(ptr, struct ci13xxx_req, queue);
|
|
|
|
n += scnprintf(buf + n, PAGE_SIZE - n,
|
|
"EP=%02i: TD=%08X %s\n",
|
|
i % ci->hw_ep_max/2, (u32)req->dma,
|
|
((i < ci->hw_ep_max/2) ? "RX" : "TX"));
|
|
|
|
for (j = 0; j < qSize; j++)
|
|
n += scnprintf(buf + n, PAGE_SIZE - n,
|
|
" %04X: %08X\n", j,
|
|
*((u32 *)req->ptr + j));
|
|
}
|
|
spin_unlock_irqrestore(&ci->lock, flags);
|
|
|
|
return n;
|
|
}
|
|
static DEVICE_ATTR(requests, S_IRUSR, show_requests, NULL);
|
|
|
|
/**
|
|
* dbg_create_files: initializes the attribute interface
|
|
* @dev: device
|
|
*
|
|
* This function returns an error code
|
|
*/
|
|
int dbg_create_files(struct device *dev)
|
|
{
|
|
int retval = 0;
|
|
|
|
if (dev == NULL)
|
|
return -EINVAL;
|
|
retval = device_create_file(dev, &dev_attr_device);
|
|
if (retval)
|
|
goto done;
|
|
retval = device_create_file(dev, &dev_attr_driver);
|
|
if (retval)
|
|
goto rm_device;
|
|
retval = device_create_file(dev, &dev_attr_events);
|
|
if (retval)
|
|
goto rm_driver;
|
|
retval = device_create_file(dev, &dev_attr_inters);
|
|
if (retval)
|
|
goto rm_events;
|
|
retval = device_create_file(dev, &dev_attr_port_test);
|
|
if (retval)
|
|
goto rm_inters;
|
|
retval = device_create_file(dev, &dev_attr_qheads);
|
|
if (retval)
|
|
goto rm_port_test;
|
|
retval = device_create_file(dev, &dev_attr_registers);
|
|
if (retval)
|
|
goto rm_qheads;
|
|
retval = device_create_file(dev, &dev_attr_requests);
|
|
if (retval)
|
|
goto rm_registers;
|
|
return 0;
|
|
|
|
rm_registers:
|
|
device_remove_file(dev, &dev_attr_registers);
|
|
rm_qheads:
|
|
device_remove_file(dev, &dev_attr_qheads);
|
|
rm_port_test:
|
|
device_remove_file(dev, &dev_attr_port_test);
|
|
rm_inters:
|
|
device_remove_file(dev, &dev_attr_inters);
|
|
rm_events:
|
|
device_remove_file(dev, &dev_attr_events);
|
|
rm_driver:
|
|
device_remove_file(dev, &dev_attr_driver);
|
|
rm_device:
|
|
device_remove_file(dev, &dev_attr_device);
|
|
done:
|
|
return retval;
|
|
}
|
|
|
|
/**
|
|
* dbg_remove_files: destroys the attribute interface
|
|
* @dev: device
|
|
*
|
|
* This function returns an error code
|
|
*/
|
|
int dbg_remove_files(struct device *dev)
|
|
{
|
|
if (dev == NULL)
|
|
return -EINVAL;
|
|
device_remove_file(dev, &dev_attr_requests);
|
|
device_remove_file(dev, &dev_attr_registers);
|
|
device_remove_file(dev, &dev_attr_qheads);
|
|
device_remove_file(dev, &dev_attr_port_test);
|
|
device_remove_file(dev, &dev_attr_inters);
|
|
device_remove_file(dev, &dev_attr_events);
|
|
device_remove_file(dev, &dev_attr_driver);
|
|
device_remove_file(dev, &dev_attr_device);
|
|
return 0;
|
|
}
|