Creation of Cybook 2416 (actually Gen4) repository
This commit is contained in:
40
drivers/mfd/Kconfig
Normal file
40
drivers/mfd/Kconfig
Normal file
@@ -0,0 +1,40 @@
|
||||
#
|
||||
# Multifunction miscellaneous devices
|
||||
#
|
||||
|
||||
menu "Multifunction device drivers"
|
||||
|
||||
config MFD_SM501
|
||||
tristate "Support for Silicon Motion SM501"
|
||||
---help---
|
||||
This is the core driver for the Silicon Motion SM501 multimedia
|
||||
companion chip. This device is a multifunction device which may
|
||||
provide numerous interfaces including USB host controller USB gadget,
|
||||
Asyncronous Serial ports, Audio functions and a dual display video
|
||||
interface. The device may be connected by PCI or local bus with
|
||||
varying functions enabled.
|
||||
|
||||
endmenu
|
||||
|
||||
menu "Multimedia Capabilities Port drivers"
|
||||
depends on ARCH_SA1100
|
||||
|
||||
config MCP
|
||||
tristate
|
||||
|
||||
# Interface drivers
|
||||
config MCP_SA11X0
|
||||
tristate "Support SA11x0 MCP interface"
|
||||
depends on ARCH_SA1100
|
||||
select MCP
|
||||
|
||||
# Chip drivers
|
||||
config MCP_UCB1200
|
||||
tristate "Support for UCB1200 / UCB1300"
|
||||
depends on MCP
|
||||
|
||||
config MCP_UCB1200_TS
|
||||
tristate "Touchscreen interface support"
|
||||
depends on MCP_UCB1200 && INPUT
|
||||
|
||||
endmenu
|
||||
14
drivers/mfd/Makefile
Normal file
14
drivers/mfd/Makefile
Normal file
@@ -0,0 +1,14 @@
|
||||
#
|
||||
# Makefile for multifunction miscellaneous devices
|
||||
#
|
||||
|
||||
obj-$(CONFIG_MFD_SM501) += sm501.o
|
||||
|
||||
obj-$(CONFIG_MCP) += mcp-core.o
|
||||
obj-$(CONFIG_MCP_SA11X0) += mcp-sa11x0.o
|
||||
obj-$(CONFIG_MCP_UCB1200) += ucb1x00-core.o
|
||||
obj-$(CONFIG_MCP_UCB1200_TS) += ucb1x00-ts.o
|
||||
|
||||
ifeq ($(CONFIG_SA1100_ASSABET),y)
|
||||
obj-$(CONFIG_MCP_UCB1200) += ucb1x00-assabet.o
|
||||
endif
|
||||
257
drivers/mfd/mcp-core.c
Normal file
257
drivers/mfd/mcp-core.c
Normal file
@@ -0,0 +1,257 @@
|
||||
/*
|
||||
* linux/drivers/mfd/mcp-core.c
|
||||
*
|
||||
* Copyright (C) 2001 Russell King
|
||||
*
|
||||
* 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.
|
||||
*
|
||||
* Generic MCP (Multimedia Communications Port) layer. All MCP locking
|
||||
* is solely held within this file.
|
||||
*/
|
||||
#include <linux/module.h>
|
||||
#include <linux/init.h>
|
||||
#include <linux/errno.h>
|
||||
#include <linux/smp.h>
|
||||
#include <linux/device.h>
|
||||
#include <linux/slab.h>
|
||||
#include <linux/string.h>
|
||||
|
||||
#include <asm/dma.h>
|
||||
#include <asm/system.h>
|
||||
|
||||
#include "mcp.h"
|
||||
|
||||
#define to_mcp(d) container_of(d, struct mcp, attached_device)
|
||||
#define to_mcp_driver(d) container_of(d, struct mcp_driver, drv)
|
||||
|
||||
static int mcp_bus_match(struct device *dev, struct device_driver *drv)
|
||||
{
|
||||
return 1;
|
||||
}
|
||||
|
||||
static int mcp_bus_probe(struct device *dev)
|
||||
{
|
||||
struct mcp *mcp = to_mcp(dev);
|
||||
struct mcp_driver *drv = to_mcp_driver(dev->driver);
|
||||
|
||||
return drv->probe(mcp);
|
||||
}
|
||||
|
||||
static int mcp_bus_remove(struct device *dev)
|
||||
{
|
||||
struct mcp *mcp = to_mcp(dev);
|
||||
struct mcp_driver *drv = to_mcp_driver(dev->driver);
|
||||
|
||||
drv->remove(mcp);
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int mcp_bus_suspend(struct device *dev, pm_message_t state)
|
||||
{
|
||||
struct mcp *mcp = to_mcp(dev);
|
||||
int ret = 0;
|
||||
|
||||
if (dev->driver) {
|
||||
struct mcp_driver *drv = to_mcp_driver(dev->driver);
|
||||
|
||||
ret = drv->suspend(mcp, state);
|
||||
}
|
||||
return ret;
|
||||
}
|
||||
|
||||
static int mcp_bus_resume(struct device *dev)
|
||||
{
|
||||
struct mcp *mcp = to_mcp(dev);
|
||||
int ret = 0;
|
||||
|
||||
if (dev->driver) {
|
||||
struct mcp_driver *drv = to_mcp_driver(dev->driver);
|
||||
|
||||
ret = drv->resume(mcp);
|
||||
}
|
||||
return ret;
|
||||
}
|
||||
|
||||
static struct bus_type mcp_bus_type = {
|
||||
.name = "mcp",
|
||||
.match = mcp_bus_match,
|
||||
.probe = mcp_bus_probe,
|
||||
.remove = mcp_bus_remove,
|
||||
.suspend = mcp_bus_suspend,
|
||||
.resume = mcp_bus_resume,
|
||||
};
|
||||
|
||||
/**
|
||||
* mcp_set_telecom_divisor - set the telecom divisor
|
||||
* @mcp: MCP interface structure
|
||||
* @div: SIB clock divisor
|
||||
*
|
||||
* Set the telecom divisor on the MCP interface. The resulting
|
||||
* sample rate is SIBCLOCK/div.
|
||||
*/
|
||||
void mcp_set_telecom_divisor(struct mcp *mcp, unsigned int div)
|
||||
{
|
||||
spin_lock_irq(&mcp->lock);
|
||||
mcp->ops->set_telecom_divisor(mcp, div);
|
||||
spin_unlock_irq(&mcp->lock);
|
||||
}
|
||||
EXPORT_SYMBOL(mcp_set_telecom_divisor);
|
||||
|
||||
/**
|
||||
* mcp_set_audio_divisor - set the audio divisor
|
||||
* @mcp: MCP interface structure
|
||||
* @div: SIB clock divisor
|
||||
*
|
||||
* Set the audio divisor on the MCP interface.
|
||||
*/
|
||||
void mcp_set_audio_divisor(struct mcp *mcp, unsigned int div)
|
||||
{
|
||||
spin_lock_irq(&mcp->lock);
|
||||
mcp->ops->set_audio_divisor(mcp, div);
|
||||
spin_unlock_irq(&mcp->lock);
|
||||
}
|
||||
EXPORT_SYMBOL(mcp_set_audio_divisor);
|
||||
|
||||
/**
|
||||
* mcp_reg_write - write a device register
|
||||
* @mcp: MCP interface structure
|
||||
* @reg: 4-bit register index
|
||||
* @val: 16-bit data value
|
||||
*
|
||||
* Write a device register. The MCP interface must be enabled
|
||||
* to prevent this function hanging.
|
||||
*/
|
||||
void mcp_reg_write(struct mcp *mcp, unsigned int reg, unsigned int val)
|
||||
{
|
||||
unsigned long flags;
|
||||
|
||||
spin_lock_irqsave(&mcp->lock, flags);
|
||||
mcp->ops->reg_write(mcp, reg, val);
|
||||
spin_unlock_irqrestore(&mcp->lock, flags);
|
||||
}
|
||||
EXPORT_SYMBOL(mcp_reg_write);
|
||||
|
||||
/**
|
||||
* mcp_reg_read - read a device register
|
||||
* @mcp: MCP interface structure
|
||||
* @reg: 4-bit register index
|
||||
*
|
||||
* Read a device register and return its value. The MCP interface
|
||||
* must be enabled to prevent this function hanging.
|
||||
*/
|
||||
unsigned int mcp_reg_read(struct mcp *mcp, unsigned int reg)
|
||||
{
|
||||
unsigned long flags;
|
||||
unsigned int val;
|
||||
|
||||
spin_lock_irqsave(&mcp->lock, flags);
|
||||
val = mcp->ops->reg_read(mcp, reg);
|
||||
spin_unlock_irqrestore(&mcp->lock, flags);
|
||||
|
||||
return val;
|
||||
}
|
||||
EXPORT_SYMBOL(mcp_reg_read);
|
||||
|
||||
/**
|
||||
* mcp_enable - enable the MCP interface
|
||||
* @mcp: MCP interface to enable
|
||||
*
|
||||
* Enable the MCP interface. Each call to mcp_enable will need
|
||||
* a corresponding call to mcp_disable to disable the interface.
|
||||
*/
|
||||
void mcp_enable(struct mcp *mcp)
|
||||
{
|
||||
spin_lock_irq(&mcp->lock);
|
||||
if (mcp->use_count++ == 0)
|
||||
mcp->ops->enable(mcp);
|
||||
spin_unlock_irq(&mcp->lock);
|
||||
}
|
||||
EXPORT_SYMBOL(mcp_enable);
|
||||
|
||||
/**
|
||||
* mcp_disable - disable the MCP interface
|
||||
* @mcp: MCP interface to disable
|
||||
*
|
||||
* Disable the MCP interface. The MCP interface will only be
|
||||
* disabled once the number of calls to mcp_enable matches the
|
||||
* number of calls to mcp_disable.
|
||||
*/
|
||||
void mcp_disable(struct mcp *mcp)
|
||||
{
|
||||
unsigned long flags;
|
||||
|
||||
spin_lock_irqsave(&mcp->lock, flags);
|
||||
if (--mcp->use_count == 0)
|
||||
mcp->ops->disable(mcp);
|
||||
spin_unlock_irqrestore(&mcp->lock, flags);
|
||||
}
|
||||
EXPORT_SYMBOL(mcp_disable);
|
||||
|
||||
static void mcp_release(struct device *dev)
|
||||
{
|
||||
struct mcp *mcp = container_of(dev, struct mcp, attached_device);
|
||||
|
||||
kfree(mcp);
|
||||
}
|
||||
|
||||
struct mcp *mcp_host_alloc(struct device *parent, size_t size)
|
||||
{
|
||||
struct mcp *mcp;
|
||||
|
||||
mcp = kmalloc(sizeof(struct mcp) + size, GFP_KERNEL);
|
||||
if (mcp) {
|
||||
memset(mcp, 0, sizeof(struct mcp) + size);
|
||||
spin_lock_init(&mcp->lock);
|
||||
mcp->attached_device.parent = parent;
|
||||
mcp->attached_device.bus = &mcp_bus_type;
|
||||
mcp->attached_device.dma_mask = parent->dma_mask;
|
||||
mcp->attached_device.release = mcp_release;
|
||||
}
|
||||
return mcp;
|
||||
}
|
||||
EXPORT_SYMBOL(mcp_host_alloc);
|
||||
|
||||
int mcp_host_register(struct mcp *mcp)
|
||||
{
|
||||
strcpy(mcp->attached_device.bus_id, "mcp0");
|
||||
return device_register(&mcp->attached_device);
|
||||
}
|
||||
EXPORT_SYMBOL(mcp_host_register);
|
||||
|
||||
void mcp_host_unregister(struct mcp *mcp)
|
||||
{
|
||||
device_unregister(&mcp->attached_device);
|
||||
}
|
||||
EXPORT_SYMBOL(mcp_host_unregister);
|
||||
|
||||
int mcp_driver_register(struct mcp_driver *mcpdrv)
|
||||
{
|
||||
mcpdrv->drv.bus = &mcp_bus_type;
|
||||
return driver_register(&mcpdrv->drv);
|
||||
}
|
||||
EXPORT_SYMBOL(mcp_driver_register);
|
||||
|
||||
void mcp_driver_unregister(struct mcp_driver *mcpdrv)
|
||||
{
|
||||
driver_unregister(&mcpdrv->drv);
|
||||
}
|
||||
EXPORT_SYMBOL(mcp_driver_unregister);
|
||||
|
||||
static int __init mcp_init(void)
|
||||
{
|
||||
return bus_register(&mcp_bus_type);
|
||||
}
|
||||
|
||||
static void __exit mcp_exit(void)
|
||||
{
|
||||
bus_unregister(&mcp_bus_type);
|
||||
}
|
||||
|
||||
module_init(mcp_init);
|
||||
module_exit(mcp_exit);
|
||||
|
||||
MODULE_AUTHOR("Russell King <rmk@arm.linux.org.uk>");
|
||||
MODULE_DESCRIPTION("Core multimedia communications port driver");
|
||||
MODULE_LICENSE("GPL");
|
||||
273
drivers/mfd/mcp-sa11x0.c
Normal file
273
drivers/mfd/mcp-sa11x0.c
Normal file
@@ -0,0 +1,273 @@
|
||||
/*
|
||||
* linux/drivers/mfd/mcp-sa11x0.c
|
||||
*
|
||||
* Copyright (C) 2001-2005 Russell King
|
||||
*
|
||||
* 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.
|
||||
*
|
||||
* SA11x0 MCP (Multimedia Communications Port) driver.
|
||||
*
|
||||
* MCP read/write timeouts from Jordi Colomer, rehacked by rmk.
|
||||
*/
|
||||
#include <linux/module.h>
|
||||
#include <linux/init.h>
|
||||
#include <linux/errno.h>
|
||||
#include <linux/kernel.h>
|
||||
#include <linux/delay.h>
|
||||
#include <linux/spinlock.h>
|
||||
#include <linux/slab.h>
|
||||
#include <linux/platform_device.h>
|
||||
|
||||
#include <asm/dma.h>
|
||||
#include <asm/hardware.h>
|
||||
#include <asm/mach-types.h>
|
||||
#include <asm/system.h>
|
||||
#include <asm/arch/mcp.h>
|
||||
|
||||
#include <asm/arch/assabet.h>
|
||||
|
||||
#include "mcp.h"
|
||||
|
||||
struct mcp_sa11x0 {
|
||||
u32 mccr0;
|
||||
u32 mccr1;
|
||||
};
|
||||
|
||||
#define priv(mcp) ((struct mcp_sa11x0 *)mcp_priv(mcp))
|
||||
|
||||
static void
|
||||
mcp_sa11x0_set_telecom_divisor(struct mcp *mcp, unsigned int divisor)
|
||||
{
|
||||
unsigned int mccr0;
|
||||
|
||||
divisor /= 32;
|
||||
|
||||
mccr0 = Ser4MCCR0 & ~0x00007f00;
|
||||
mccr0 |= divisor << 8;
|
||||
Ser4MCCR0 = mccr0;
|
||||
}
|
||||
|
||||
static void
|
||||
mcp_sa11x0_set_audio_divisor(struct mcp *mcp, unsigned int divisor)
|
||||
{
|
||||
unsigned int mccr0;
|
||||
|
||||
divisor /= 32;
|
||||
|
||||
mccr0 = Ser4MCCR0 & ~0x0000007f;
|
||||
mccr0 |= divisor;
|
||||
Ser4MCCR0 = mccr0;
|
||||
}
|
||||
|
||||
/*
|
||||
* Write data to the device. The bit should be set after 3 subframe
|
||||
* times (each frame is 64 clocks). We wait a maximum of 6 subframes.
|
||||
* We really should try doing something more productive while we
|
||||
* wait.
|
||||
*/
|
||||
static void
|
||||
mcp_sa11x0_write(struct mcp *mcp, unsigned int reg, unsigned int val)
|
||||
{
|
||||
int ret = -ETIME;
|
||||
int i;
|
||||
|
||||
Ser4MCDR2 = reg << 17 | MCDR2_Wr | (val & 0xffff);
|
||||
|
||||
for (i = 0; i < 2; i++) {
|
||||
udelay(mcp->rw_timeout);
|
||||
if (Ser4MCSR & MCSR_CWC) {
|
||||
ret = 0;
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
if (ret < 0)
|
||||
printk(KERN_WARNING "mcp: write timed out\n");
|
||||
}
|
||||
|
||||
/*
|
||||
* Read data from the device. The bit should be set after 3 subframe
|
||||
* times (each frame is 64 clocks). We wait a maximum of 6 subframes.
|
||||
* We really should try doing something more productive while we
|
||||
* wait.
|
||||
*/
|
||||
static unsigned int
|
||||
mcp_sa11x0_read(struct mcp *mcp, unsigned int reg)
|
||||
{
|
||||
int ret = -ETIME;
|
||||
int i;
|
||||
|
||||
Ser4MCDR2 = reg << 17 | MCDR2_Rd;
|
||||
|
||||
for (i = 0; i < 2; i++) {
|
||||
udelay(mcp->rw_timeout);
|
||||
if (Ser4MCSR & MCSR_CRC) {
|
||||
ret = Ser4MCDR2 & 0xffff;
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
if (ret < 0)
|
||||
printk(KERN_WARNING "mcp: read timed out\n");
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
static void mcp_sa11x0_enable(struct mcp *mcp)
|
||||
{
|
||||
Ser4MCSR = -1;
|
||||
Ser4MCCR0 |= MCCR0_MCE;
|
||||
}
|
||||
|
||||
static void mcp_sa11x0_disable(struct mcp *mcp)
|
||||
{
|
||||
Ser4MCCR0 &= ~MCCR0_MCE;
|
||||
}
|
||||
|
||||
/*
|
||||
* Our methods.
|
||||
*/
|
||||
static struct mcp_ops mcp_sa11x0 = {
|
||||
.set_telecom_divisor = mcp_sa11x0_set_telecom_divisor,
|
||||
.set_audio_divisor = mcp_sa11x0_set_audio_divisor,
|
||||
.reg_write = mcp_sa11x0_write,
|
||||
.reg_read = mcp_sa11x0_read,
|
||||
.enable = mcp_sa11x0_enable,
|
||||
.disable = mcp_sa11x0_disable,
|
||||
};
|
||||
|
||||
static int mcp_sa11x0_probe(struct platform_device *pdev)
|
||||
{
|
||||
struct mcp_plat_data *data = pdev->dev.platform_data;
|
||||
struct mcp *mcp;
|
||||
int ret;
|
||||
|
||||
if (!data)
|
||||
return -ENODEV;
|
||||
|
||||
if (!request_mem_region(0x80060000, 0x60, "sa11x0-mcp"))
|
||||
return -EBUSY;
|
||||
|
||||
mcp = mcp_host_alloc(&pdev->dev, sizeof(struct mcp_sa11x0));
|
||||
if (!mcp) {
|
||||
ret = -ENOMEM;
|
||||
goto release;
|
||||
}
|
||||
|
||||
mcp->owner = THIS_MODULE;
|
||||
mcp->ops = &mcp_sa11x0;
|
||||
mcp->sclk_rate = data->sclk_rate;
|
||||
mcp->dma_audio_rd = DMA_Ser4MCP0Rd;
|
||||
mcp->dma_audio_wr = DMA_Ser4MCP0Wr;
|
||||
mcp->dma_telco_rd = DMA_Ser4MCP1Rd;
|
||||
mcp->dma_telco_wr = DMA_Ser4MCP1Wr;
|
||||
|
||||
platform_set_drvdata(pdev, mcp);
|
||||
|
||||
if (machine_is_assabet()) {
|
||||
ASSABET_BCR_set(ASSABET_BCR_CODEC_RST);
|
||||
}
|
||||
|
||||
/*
|
||||
* Setup the PPC unit correctly.
|
||||
*/
|
||||
PPDR &= ~PPC_RXD4;
|
||||
PPDR |= PPC_TXD4 | PPC_SCLK | PPC_SFRM;
|
||||
PSDR |= PPC_RXD4;
|
||||
PSDR &= ~(PPC_TXD4 | PPC_SCLK | PPC_SFRM);
|
||||
PPSR &= ~(PPC_TXD4 | PPC_SCLK | PPC_SFRM);
|
||||
|
||||
/*
|
||||
* Initialise device. Note that we initially
|
||||
* set the sampling rate to minimum.
|
||||
*/
|
||||
Ser4MCSR = -1;
|
||||
Ser4MCCR1 = data->mccr1;
|
||||
Ser4MCCR0 = data->mccr0 | 0x7f7f;
|
||||
|
||||
/*
|
||||
* Calculate the read/write timeout (us) from the bit clock
|
||||
* rate. This is the period for 3 64-bit frames. Always
|
||||
* round this time up.
|
||||
*/
|
||||
mcp->rw_timeout = (64 * 3 * 1000000 + mcp->sclk_rate - 1) /
|
||||
mcp->sclk_rate;
|
||||
|
||||
ret = mcp_host_register(mcp);
|
||||
if (ret == 0)
|
||||
goto out;
|
||||
|
||||
release:
|
||||
release_mem_region(0x80060000, 0x60);
|
||||
platform_set_drvdata(pdev, NULL);
|
||||
|
||||
out:
|
||||
return ret;
|
||||
}
|
||||
|
||||
static int mcp_sa11x0_remove(struct platform_device *dev)
|
||||
{
|
||||
struct mcp *mcp = platform_get_drvdata(dev);
|
||||
|
||||
platform_set_drvdata(dev, NULL);
|
||||
mcp_host_unregister(mcp);
|
||||
release_mem_region(0x80060000, 0x60);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int mcp_sa11x0_suspend(struct platform_device *dev, pm_message_t state)
|
||||
{
|
||||
struct mcp *mcp = platform_get_drvdata(dev);
|
||||
|
||||
priv(mcp)->mccr0 = Ser4MCCR0;
|
||||
priv(mcp)->mccr1 = Ser4MCCR1;
|
||||
Ser4MCCR0 &= ~MCCR0_MCE;
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int mcp_sa11x0_resume(struct platform_device *dev)
|
||||
{
|
||||
struct mcp *mcp = platform_get_drvdata(dev);
|
||||
|
||||
Ser4MCCR1 = priv(mcp)->mccr1;
|
||||
Ser4MCCR0 = priv(mcp)->mccr0;
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
/*
|
||||
* The driver for the SA11x0 MCP port.
|
||||
*/
|
||||
static struct platform_driver mcp_sa11x0_driver = {
|
||||
.probe = mcp_sa11x0_probe,
|
||||
.remove = mcp_sa11x0_remove,
|
||||
.suspend = mcp_sa11x0_suspend,
|
||||
.resume = mcp_sa11x0_resume,
|
||||
.driver = {
|
||||
.name = "sa11x0-mcp",
|
||||
},
|
||||
};
|
||||
|
||||
/*
|
||||
* This needs re-working
|
||||
*/
|
||||
static int __init mcp_sa11x0_init(void)
|
||||
{
|
||||
return platform_driver_register(&mcp_sa11x0_driver);
|
||||
}
|
||||
|
||||
static void __exit mcp_sa11x0_exit(void)
|
||||
{
|
||||
platform_driver_unregister(&mcp_sa11x0_driver);
|
||||
}
|
||||
|
||||
module_init(mcp_sa11x0_init);
|
||||
module_exit(mcp_sa11x0_exit);
|
||||
|
||||
MODULE_AUTHOR("Russell King <rmk@arm.linux.org.uk>");
|
||||
MODULE_DESCRIPTION("SA11x0 multimedia communications port driver");
|
||||
MODULE_LICENSE("GPL");
|
||||
66
drivers/mfd/mcp.h
Normal file
66
drivers/mfd/mcp.h
Normal file
@@ -0,0 +1,66 @@
|
||||
/*
|
||||
* linux/drivers/mfd/mcp.h
|
||||
*
|
||||
* Copyright (C) 2001 Russell King, All Rights Reserved.
|
||||
*
|
||||
* 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.
|
||||
*/
|
||||
#ifndef MCP_H
|
||||
#define MCP_H
|
||||
|
||||
struct mcp_ops;
|
||||
|
||||
struct mcp {
|
||||
struct module *owner;
|
||||
struct mcp_ops *ops;
|
||||
spinlock_t lock;
|
||||
int use_count;
|
||||
unsigned int sclk_rate;
|
||||
unsigned int rw_timeout;
|
||||
dma_device_t dma_audio_rd;
|
||||
dma_device_t dma_audio_wr;
|
||||
dma_device_t dma_telco_rd;
|
||||
dma_device_t dma_telco_wr;
|
||||
struct device attached_device;
|
||||
};
|
||||
|
||||
struct mcp_ops {
|
||||
void (*set_telecom_divisor)(struct mcp *, unsigned int);
|
||||
void (*set_audio_divisor)(struct mcp *, unsigned int);
|
||||
void (*reg_write)(struct mcp *, unsigned int, unsigned int);
|
||||
unsigned int (*reg_read)(struct mcp *, unsigned int);
|
||||
void (*enable)(struct mcp *);
|
||||
void (*disable)(struct mcp *);
|
||||
};
|
||||
|
||||
void mcp_set_telecom_divisor(struct mcp *, unsigned int);
|
||||
void mcp_set_audio_divisor(struct mcp *, unsigned int);
|
||||
void mcp_reg_write(struct mcp *, unsigned int, unsigned int);
|
||||
unsigned int mcp_reg_read(struct mcp *, unsigned int);
|
||||
void mcp_enable(struct mcp *);
|
||||
void mcp_disable(struct mcp *);
|
||||
#define mcp_get_sclk_rate(mcp) ((mcp)->sclk_rate)
|
||||
|
||||
struct mcp *mcp_host_alloc(struct device *, size_t);
|
||||
int mcp_host_register(struct mcp *);
|
||||
void mcp_host_unregister(struct mcp *);
|
||||
|
||||
struct mcp_driver {
|
||||
struct device_driver drv;
|
||||
int (*probe)(struct mcp *);
|
||||
void (*remove)(struct mcp *);
|
||||
int (*suspend)(struct mcp *, pm_message_t);
|
||||
int (*resume)(struct mcp *);
|
||||
};
|
||||
|
||||
int mcp_driver_register(struct mcp_driver *);
|
||||
void mcp_driver_unregister(struct mcp_driver *);
|
||||
|
||||
#define mcp_get_drvdata(mcp) dev_get_drvdata(&(mcp)->attached_device)
|
||||
#define mcp_set_drvdata(mcp,d) dev_set_drvdata(&(mcp)->attached_device, d)
|
||||
|
||||
#define mcp_priv(mcp) ((void *)((mcp)+1))
|
||||
|
||||
#endif
|
||||
1148
drivers/mfd/sm501.c
Normal file
1148
drivers/mfd/sm501.c
Normal file
File diff suppressed because it is too large
Load Diff
73
drivers/mfd/ucb1x00-assabet.c
Normal file
73
drivers/mfd/ucb1x00-assabet.c
Normal file
@@ -0,0 +1,73 @@
|
||||
/*
|
||||
* linux/drivers/mfd/ucb1x00-assabet.c
|
||||
*
|
||||
* Copyright (C) 2001-2003 Russell King, All Rights Reserved.
|
||||
*
|
||||
* 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.
|
||||
*
|
||||
* We handle the machine-specific bits of the UCB1x00 driver here.
|
||||
*/
|
||||
#include <linux/module.h>
|
||||
#include <linux/init.h>
|
||||
#include <linux/fs.h>
|
||||
#include <linux/proc_fs.h>
|
||||
#include <linux/device.h>
|
||||
|
||||
#include <asm/dma.h>
|
||||
|
||||
#include "ucb1x00.h"
|
||||
|
||||
#define UCB1X00_ATTR(name,input)\
|
||||
static ssize_t name##_show(struct class_device *dev, char *buf) \
|
||||
{ \
|
||||
struct ucb1x00 *ucb = classdev_to_ucb1x00(dev); \
|
||||
int val; \
|
||||
ucb1x00_adc_enable(ucb); \
|
||||
val = ucb1x00_adc_read(ucb, input, UCB_NOSYNC); \
|
||||
ucb1x00_adc_disable(ucb); \
|
||||
return sprintf(buf, "%d\n", val); \
|
||||
} \
|
||||
static CLASS_DEVICE_ATTR(name,0444,name##_show,NULL)
|
||||
|
||||
UCB1X00_ATTR(vbatt, UCB_ADC_INP_AD1);
|
||||
UCB1X00_ATTR(vcharger, UCB_ADC_INP_AD0);
|
||||
UCB1X00_ATTR(batt_temp, UCB_ADC_INP_AD2);
|
||||
|
||||
static int ucb1x00_assabet_add(struct ucb1x00_dev *dev)
|
||||
{
|
||||
class_device_create_file(&dev->ucb->cdev, &class_device_attr_vbatt);
|
||||
class_device_create_file(&dev->ucb->cdev, &class_device_attr_vcharger);
|
||||
class_device_create_file(&dev->ucb->cdev, &class_device_attr_batt_temp);
|
||||
return 0;
|
||||
}
|
||||
|
||||
static void ucb1x00_assabet_remove(struct ucb1x00_dev *dev)
|
||||
{
|
||||
class_device_remove_file(&dev->ucb->cdev, &class_device_attr_batt_temp);
|
||||
class_device_remove_file(&dev->ucb->cdev, &class_device_attr_vcharger);
|
||||
class_device_remove_file(&dev->ucb->cdev, &class_device_attr_vbatt);
|
||||
}
|
||||
|
||||
static struct ucb1x00_driver ucb1x00_assabet_driver = {
|
||||
.add = ucb1x00_assabet_add,
|
||||
.remove = ucb1x00_assabet_remove,
|
||||
};
|
||||
|
||||
static int __init ucb1x00_assabet_init(void)
|
||||
{
|
||||
return ucb1x00_register_driver(&ucb1x00_assabet_driver);
|
||||
}
|
||||
|
||||
static void __exit ucb1x00_assabet_exit(void)
|
||||
{
|
||||
ucb1x00_unregister_driver(&ucb1x00_assabet_driver);
|
||||
}
|
||||
|
||||
module_init(ucb1x00_assabet_init);
|
||||
module_exit(ucb1x00_assabet_exit);
|
||||
|
||||
MODULE_AUTHOR("Russell King <rmk@arm.linux.org.uk>");
|
||||
MODULE_DESCRIPTION("Assabet noddy testing only example ADC driver");
|
||||
MODULE_LICENSE("GPL");
|
||||
664
drivers/mfd/ucb1x00-core.c
Normal file
664
drivers/mfd/ucb1x00-core.c
Normal file
@@ -0,0 +1,664 @@
|
||||
/*
|
||||
* linux/drivers/mfd/ucb1x00-core.c
|
||||
*
|
||||
* Copyright (C) 2001 Russell King, All Rights Reserved.
|
||||
*
|
||||
* 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.
|
||||
*
|
||||
* The UCB1x00 core driver provides basic services for handling IO,
|
||||
* the ADC, interrupts, and accessing registers. It is designed
|
||||
* such that everything goes through this layer, thereby providing
|
||||
* a consistent locking methodology, as well as allowing the drivers
|
||||
* to be used on other non-MCP-enabled hardware platforms.
|
||||
*
|
||||
* Note that all locks are private to this file. Nothing else may
|
||||
* touch them.
|
||||
*/
|
||||
#include <linux/module.h>
|
||||
#include <linux/kernel.h>
|
||||
#include <linux/slab.h>
|
||||
#include <linux/init.h>
|
||||
#include <linux/errno.h>
|
||||
#include <linux/interrupt.h>
|
||||
#include <linux/device.h>
|
||||
#include <linux/mutex.h>
|
||||
|
||||
#include <asm/dma.h>
|
||||
#include <asm/hardware.h>
|
||||
|
||||
#include "ucb1x00.h"
|
||||
|
||||
static DEFINE_MUTEX(ucb1x00_mutex);
|
||||
static LIST_HEAD(ucb1x00_drivers);
|
||||
static LIST_HEAD(ucb1x00_devices);
|
||||
|
||||
/**
|
||||
* ucb1x00_io_set_dir - set IO direction
|
||||
* @ucb: UCB1x00 structure describing chip
|
||||
* @in: bitfield of IO pins to be set as inputs
|
||||
* @out: bitfield of IO pins to be set as outputs
|
||||
*
|
||||
* Set the IO direction of the ten general purpose IO pins on
|
||||
* the UCB1x00 chip. The @in bitfield has priority over the
|
||||
* @out bitfield, in that if you specify a pin as both input
|
||||
* and output, it will end up as an input.
|
||||
*
|
||||
* ucb1x00_enable must have been called to enable the comms
|
||||
* before using this function.
|
||||
*
|
||||
* This function takes a spinlock, disabling interrupts.
|
||||
*/
|
||||
void ucb1x00_io_set_dir(struct ucb1x00 *ucb, unsigned int in, unsigned int out)
|
||||
{
|
||||
unsigned long flags;
|
||||
|
||||
spin_lock_irqsave(&ucb->io_lock, flags);
|
||||
ucb->io_dir |= out;
|
||||
ucb->io_dir &= ~in;
|
||||
|
||||
ucb1x00_reg_write(ucb, UCB_IO_DIR, ucb->io_dir);
|
||||
spin_unlock_irqrestore(&ucb->io_lock, flags);
|
||||
}
|
||||
|
||||
/**
|
||||
* ucb1x00_io_write - set or clear IO outputs
|
||||
* @ucb: UCB1x00 structure describing chip
|
||||
* @set: bitfield of IO pins to set to logic '1'
|
||||
* @clear: bitfield of IO pins to set to logic '0'
|
||||
*
|
||||
* Set the IO output state of the specified IO pins. The value
|
||||
* is retained if the pins are subsequently configured as inputs.
|
||||
* The @clear bitfield has priority over the @set bitfield -
|
||||
* outputs will be cleared.
|
||||
*
|
||||
* ucb1x00_enable must have been called to enable the comms
|
||||
* before using this function.
|
||||
*
|
||||
* This function takes a spinlock, disabling interrupts.
|
||||
*/
|
||||
void ucb1x00_io_write(struct ucb1x00 *ucb, unsigned int set, unsigned int clear)
|
||||
{
|
||||
unsigned long flags;
|
||||
|
||||
spin_lock_irqsave(&ucb->io_lock, flags);
|
||||
ucb->io_out |= set;
|
||||
ucb->io_out &= ~clear;
|
||||
|
||||
ucb1x00_reg_write(ucb, UCB_IO_DATA, ucb->io_out);
|
||||
spin_unlock_irqrestore(&ucb->io_lock, flags);
|
||||
}
|
||||
|
||||
/**
|
||||
* ucb1x00_io_read - read the current state of the IO pins
|
||||
* @ucb: UCB1x00 structure describing chip
|
||||
*
|
||||
* Return a bitfield describing the logic state of the ten
|
||||
* general purpose IO pins.
|
||||
*
|
||||
* ucb1x00_enable must have been called to enable the comms
|
||||
* before using this function.
|
||||
*
|
||||
* This function does not take any semaphores or spinlocks.
|
||||
*/
|
||||
unsigned int ucb1x00_io_read(struct ucb1x00 *ucb)
|
||||
{
|
||||
return ucb1x00_reg_read(ucb, UCB_IO_DATA);
|
||||
}
|
||||
|
||||
/*
|
||||
* UCB1300 data sheet says we must:
|
||||
* 1. enable ADC => 5us (including reference startup time)
|
||||
* 2. select input => 51*tsibclk => 4.3us
|
||||
* 3. start conversion => 102*tsibclk => 8.5us
|
||||
* (tsibclk = 1/11981000)
|
||||
* Period between SIB 128-bit frames = 10.7us
|
||||
*/
|
||||
|
||||
/**
|
||||
* ucb1x00_adc_enable - enable the ADC converter
|
||||
* @ucb: UCB1x00 structure describing chip
|
||||
*
|
||||
* Enable the ucb1x00 and ADC converter on the UCB1x00 for use.
|
||||
* Any code wishing to use the ADC converter must call this
|
||||
* function prior to using it.
|
||||
*
|
||||
* This function takes the ADC semaphore to prevent two or more
|
||||
* concurrent uses, and therefore may sleep. As a result, it
|
||||
* can only be called from process context, not interrupt
|
||||
* context.
|
||||
*
|
||||
* You should release the ADC as soon as possible using
|
||||
* ucb1x00_adc_disable.
|
||||
*/
|
||||
void ucb1x00_adc_enable(struct ucb1x00 *ucb)
|
||||
{
|
||||
down(&ucb->adc_sem);
|
||||
|
||||
ucb->adc_cr |= UCB_ADC_ENA;
|
||||
|
||||
ucb1x00_enable(ucb);
|
||||
ucb1x00_reg_write(ucb, UCB_ADC_CR, ucb->adc_cr);
|
||||
}
|
||||
|
||||
/**
|
||||
* ucb1x00_adc_read - read the specified ADC channel
|
||||
* @ucb: UCB1x00 structure describing chip
|
||||
* @adc_channel: ADC channel mask
|
||||
* @sync: wait for syncronisation pulse.
|
||||
*
|
||||
* Start an ADC conversion and wait for the result. Note that
|
||||
* synchronised ADC conversions (via the ADCSYNC pin) must wait
|
||||
* until the trigger is asserted and the conversion is finished.
|
||||
*
|
||||
* This function currently spins waiting for the conversion to
|
||||
* complete (2 frames max without sync).
|
||||
*
|
||||
* If called for a synchronised ADC conversion, it may sleep
|
||||
* with the ADC semaphore held.
|
||||
*/
|
||||
unsigned int ucb1x00_adc_read(struct ucb1x00 *ucb, int adc_channel, int sync)
|
||||
{
|
||||
unsigned int val;
|
||||
|
||||
if (sync)
|
||||
adc_channel |= UCB_ADC_SYNC_ENA;
|
||||
|
||||
ucb1x00_reg_write(ucb, UCB_ADC_CR, ucb->adc_cr | adc_channel);
|
||||
ucb1x00_reg_write(ucb, UCB_ADC_CR, ucb->adc_cr | adc_channel | UCB_ADC_START);
|
||||
|
||||
for (;;) {
|
||||
val = ucb1x00_reg_read(ucb, UCB_ADC_DATA);
|
||||
if (val & UCB_ADC_DAT_VAL)
|
||||
break;
|
||||
/* yield to other processes */
|
||||
set_current_state(TASK_INTERRUPTIBLE);
|
||||
schedule_timeout(1);
|
||||
}
|
||||
|
||||
return UCB_ADC_DAT(val);
|
||||
}
|
||||
|
||||
/**
|
||||
* ucb1x00_adc_disable - disable the ADC converter
|
||||
* @ucb: UCB1x00 structure describing chip
|
||||
*
|
||||
* Disable the ADC converter and release the ADC semaphore.
|
||||
*/
|
||||
void ucb1x00_adc_disable(struct ucb1x00 *ucb)
|
||||
{
|
||||
ucb->adc_cr &= ~UCB_ADC_ENA;
|
||||
ucb1x00_reg_write(ucb, UCB_ADC_CR, ucb->adc_cr);
|
||||
ucb1x00_disable(ucb);
|
||||
|
||||
up(&ucb->adc_sem);
|
||||
}
|
||||
|
||||
/*
|
||||
* UCB1x00 Interrupt handling.
|
||||
*
|
||||
* The UCB1x00 can generate interrupts when the SIBCLK is stopped.
|
||||
* Since we need to read an internal register, we must re-enable
|
||||
* SIBCLK to talk to the chip. We leave the clock running until
|
||||
* we have finished processing all interrupts from the chip.
|
||||
*/
|
||||
static irqreturn_t ucb1x00_irq(int irqnr, void *devid)
|
||||
{
|
||||
struct ucb1x00 *ucb = devid;
|
||||
struct ucb1x00_irq *irq;
|
||||
unsigned int isr, i;
|
||||
|
||||
ucb1x00_enable(ucb);
|
||||
isr = ucb1x00_reg_read(ucb, UCB_IE_STATUS);
|
||||
ucb1x00_reg_write(ucb, UCB_IE_CLEAR, isr);
|
||||
ucb1x00_reg_write(ucb, UCB_IE_CLEAR, 0);
|
||||
|
||||
for (i = 0, irq = ucb->irq_handler; i < 16 && isr; i++, isr >>= 1, irq++)
|
||||
if (isr & 1 && irq->fn)
|
||||
irq->fn(i, irq->devid);
|
||||
ucb1x00_disable(ucb);
|
||||
|
||||
return IRQ_HANDLED;
|
||||
}
|
||||
|
||||
/**
|
||||
* ucb1x00_hook_irq - hook a UCB1x00 interrupt
|
||||
* @ucb: UCB1x00 structure describing chip
|
||||
* @idx: interrupt index
|
||||
* @fn: function to call when interrupt is triggered
|
||||
* @devid: device id to pass to interrupt handler
|
||||
*
|
||||
* Hook the specified interrupt. You can only register one handler
|
||||
* for each interrupt source. The interrupt source is not enabled
|
||||
* by this function; use ucb1x00_enable_irq instead.
|
||||
*
|
||||
* Interrupt handlers will be called with other interrupts enabled.
|
||||
*
|
||||
* Returns zero on success, or one of the following errors:
|
||||
* -EINVAL if the interrupt index is invalid
|
||||
* -EBUSY if the interrupt has already been hooked
|
||||
*/
|
||||
int ucb1x00_hook_irq(struct ucb1x00 *ucb, unsigned int idx, void (*fn)(int, void *), void *devid)
|
||||
{
|
||||
struct ucb1x00_irq *irq;
|
||||
int ret = -EINVAL;
|
||||
|
||||
if (idx < 16) {
|
||||
irq = ucb->irq_handler + idx;
|
||||
ret = -EBUSY;
|
||||
|
||||
spin_lock_irq(&ucb->lock);
|
||||
if (irq->fn == NULL) {
|
||||
irq->devid = devid;
|
||||
irq->fn = fn;
|
||||
ret = 0;
|
||||
}
|
||||
spin_unlock_irq(&ucb->lock);
|
||||
}
|
||||
return ret;
|
||||
}
|
||||
|
||||
/**
|
||||
* ucb1x00_enable_irq - enable an UCB1x00 interrupt source
|
||||
* @ucb: UCB1x00 structure describing chip
|
||||
* @idx: interrupt index
|
||||
* @edges: interrupt edges to enable
|
||||
*
|
||||
* Enable the specified interrupt to trigger on %UCB_RISING,
|
||||
* %UCB_FALLING or both edges. The interrupt should have been
|
||||
* hooked by ucb1x00_hook_irq.
|
||||
*/
|
||||
void ucb1x00_enable_irq(struct ucb1x00 *ucb, unsigned int idx, int edges)
|
||||
{
|
||||
unsigned long flags;
|
||||
|
||||
if (idx < 16) {
|
||||
spin_lock_irqsave(&ucb->lock, flags);
|
||||
|
||||
ucb1x00_enable(ucb);
|
||||
if (edges & UCB_RISING) {
|
||||
ucb->irq_ris_enbl |= 1 << idx;
|
||||
ucb1x00_reg_write(ucb, UCB_IE_RIS, ucb->irq_ris_enbl);
|
||||
}
|
||||
if (edges & UCB_FALLING) {
|
||||
ucb->irq_fal_enbl |= 1 << idx;
|
||||
ucb1x00_reg_write(ucb, UCB_IE_FAL, ucb->irq_fal_enbl);
|
||||
}
|
||||
ucb1x00_disable(ucb);
|
||||
spin_unlock_irqrestore(&ucb->lock, flags);
|
||||
}
|
||||
}
|
||||
|
||||
/**
|
||||
* ucb1x00_disable_irq - disable an UCB1x00 interrupt source
|
||||
* @ucb: UCB1x00 structure describing chip
|
||||
* @edges: interrupt edges to disable
|
||||
*
|
||||
* Disable the specified interrupt triggering on the specified
|
||||
* (%UCB_RISING, %UCB_FALLING or both) edges.
|
||||
*/
|
||||
void ucb1x00_disable_irq(struct ucb1x00 *ucb, unsigned int idx, int edges)
|
||||
{
|
||||
unsigned long flags;
|
||||
|
||||
if (idx < 16) {
|
||||
spin_lock_irqsave(&ucb->lock, flags);
|
||||
|
||||
ucb1x00_enable(ucb);
|
||||
if (edges & UCB_RISING) {
|
||||
ucb->irq_ris_enbl &= ~(1 << idx);
|
||||
ucb1x00_reg_write(ucb, UCB_IE_RIS, ucb->irq_ris_enbl);
|
||||
}
|
||||
if (edges & UCB_FALLING) {
|
||||
ucb->irq_fal_enbl &= ~(1 << idx);
|
||||
ucb1x00_reg_write(ucb, UCB_IE_FAL, ucb->irq_fal_enbl);
|
||||
}
|
||||
ucb1x00_disable(ucb);
|
||||
spin_unlock_irqrestore(&ucb->lock, flags);
|
||||
}
|
||||
}
|
||||
|
||||
/**
|
||||
* ucb1x00_free_irq - disable and free the specified UCB1x00 interrupt
|
||||
* @ucb: UCB1x00 structure describing chip
|
||||
* @idx: interrupt index
|
||||
* @devid: device id.
|
||||
*
|
||||
* Disable the interrupt source and remove the handler. devid must
|
||||
* match the devid passed when hooking the interrupt.
|
||||
*
|
||||
* Returns zero on success, or one of the following errors:
|
||||
* -EINVAL if the interrupt index is invalid
|
||||
* -ENOENT if devid does not match
|
||||
*/
|
||||
int ucb1x00_free_irq(struct ucb1x00 *ucb, unsigned int idx, void *devid)
|
||||
{
|
||||
struct ucb1x00_irq *irq;
|
||||
int ret;
|
||||
|
||||
if (idx >= 16)
|
||||
goto bad;
|
||||
|
||||
irq = ucb->irq_handler + idx;
|
||||
ret = -ENOENT;
|
||||
|
||||
spin_lock_irq(&ucb->lock);
|
||||
if (irq->devid == devid) {
|
||||
ucb->irq_ris_enbl &= ~(1 << idx);
|
||||
ucb->irq_fal_enbl &= ~(1 << idx);
|
||||
|
||||
ucb1x00_enable(ucb);
|
||||
ucb1x00_reg_write(ucb, UCB_IE_RIS, ucb->irq_ris_enbl);
|
||||
ucb1x00_reg_write(ucb, UCB_IE_FAL, ucb->irq_fal_enbl);
|
||||
ucb1x00_disable(ucb);
|
||||
|
||||
irq->fn = NULL;
|
||||
irq->devid = NULL;
|
||||
ret = 0;
|
||||
}
|
||||
spin_unlock_irq(&ucb->lock);
|
||||
return ret;
|
||||
|
||||
bad:
|
||||
printk(KERN_ERR "Freeing bad UCB1x00 irq %d\n", idx);
|
||||
return -EINVAL;
|
||||
}
|
||||
|
||||
static int ucb1x00_add_dev(struct ucb1x00 *ucb, struct ucb1x00_driver *drv)
|
||||
{
|
||||
struct ucb1x00_dev *dev;
|
||||
int ret = -ENOMEM;
|
||||
|
||||
dev = kmalloc(sizeof(struct ucb1x00_dev), GFP_KERNEL);
|
||||
if (dev) {
|
||||
dev->ucb = ucb;
|
||||
dev->drv = drv;
|
||||
|
||||
ret = drv->add(dev);
|
||||
|
||||
if (ret == 0) {
|
||||
list_add(&dev->dev_node, &ucb->devs);
|
||||
list_add(&dev->drv_node, &drv->devs);
|
||||
} else {
|
||||
kfree(dev);
|
||||
}
|
||||
}
|
||||
return ret;
|
||||
}
|
||||
|
||||
static void ucb1x00_remove_dev(struct ucb1x00_dev *dev)
|
||||
{
|
||||
dev->drv->remove(dev);
|
||||
list_del(&dev->dev_node);
|
||||
list_del(&dev->drv_node);
|
||||
kfree(dev);
|
||||
}
|
||||
|
||||
/*
|
||||
* Try to probe our interrupt, rather than relying on lots of
|
||||
* hard-coded machine dependencies. For reference, the expected
|
||||
* IRQ mappings are:
|
||||
*
|
||||
* Machine Default IRQ
|
||||
* adsbitsy IRQ_GPCIN4
|
||||
* cerf IRQ_GPIO_UCB1200_IRQ
|
||||
* flexanet IRQ_GPIO_GUI
|
||||
* freebird IRQ_GPIO_FREEBIRD_UCB1300_IRQ
|
||||
* graphicsclient ADS_EXT_IRQ(8)
|
||||
* graphicsmaster ADS_EXT_IRQ(8)
|
||||
* lart LART_IRQ_UCB1200
|
||||
* omnimeter IRQ_GPIO23
|
||||
* pfs168 IRQ_GPIO_UCB1300_IRQ
|
||||
* simpad IRQ_GPIO_UCB1300_IRQ
|
||||
* shannon SHANNON_IRQ_GPIO_IRQ_CODEC
|
||||
* yopy IRQ_GPIO_UCB1200_IRQ
|
||||
*/
|
||||
static int ucb1x00_detect_irq(struct ucb1x00 *ucb)
|
||||
{
|
||||
unsigned long mask;
|
||||
|
||||
mask = probe_irq_on();
|
||||
if (!mask) {
|
||||
probe_irq_off(mask);
|
||||
return NO_IRQ;
|
||||
}
|
||||
|
||||
/*
|
||||
* Enable the ADC interrupt.
|
||||
*/
|
||||
ucb1x00_reg_write(ucb, UCB_IE_RIS, UCB_IE_ADC);
|
||||
ucb1x00_reg_write(ucb, UCB_IE_FAL, UCB_IE_ADC);
|
||||
ucb1x00_reg_write(ucb, UCB_IE_CLEAR, 0xffff);
|
||||
ucb1x00_reg_write(ucb, UCB_IE_CLEAR, 0);
|
||||
|
||||
/*
|
||||
* Cause an ADC interrupt.
|
||||
*/
|
||||
ucb1x00_reg_write(ucb, UCB_ADC_CR, UCB_ADC_ENA);
|
||||
ucb1x00_reg_write(ucb, UCB_ADC_CR, UCB_ADC_ENA | UCB_ADC_START);
|
||||
|
||||
/*
|
||||
* Wait for the conversion to complete.
|
||||
*/
|
||||
while ((ucb1x00_reg_read(ucb, UCB_ADC_DATA) & UCB_ADC_DAT_VAL) == 0);
|
||||
ucb1x00_reg_write(ucb, UCB_ADC_CR, 0);
|
||||
|
||||
/*
|
||||
* Disable and clear interrupt.
|
||||
*/
|
||||
ucb1x00_reg_write(ucb, UCB_IE_RIS, 0);
|
||||
ucb1x00_reg_write(ucb, UCB_IE_FAL, 0);
|
||||
ucb1x00_reg_write(ucb, UCB_IE_CLEAR, 0xffff);
|
||||
ucb1x00_reg_write(ucb, UCB_IE_CLEAR, 0);
|
||||
|
||||
/*
|
||||
* Read triggered interrupt.
|
||||
*/
|
||||
return probe_irq_off(mask);
|
||||
}
|
||||
|
||||
static void ucb1x00_release(struct class_device *dev)
|
||||
{
|
||||
struct ucb1x00 *ucb = classdev_to_ucb1x00(dev);
|
||||
kfree(ucb);
|
||||
}
|
||||
|
||||
static struct class ucb1x00_class = {
|
||||
.name = "ucb1x00",
|
||||
.release = ucb1x00_release,
|
||||
};
|
||||
|
||||
static int ucb1x00_probe(struct mcp *mcp)
|
||||
{
|
||||
struct ucb1x00 *ucb;
|
||||
struct ucb1x00_driver *drv;
|
||||
unsigned int id;
|
||||
int ret = -ENODEV;
|
||||
|
||||
mcp_enable(mcp);
|
||||
id = mcp_reg_read(mcp, UCB_ID);
|
||||
|
||||
if (id != UCB_ID_1200 && id != UCB_ID_1300 && id != UCB_ID_TC35143) {
|
||||
printk(KERN_WARNING "UCB1x00 ID not found: %04x\n", id);
|
||||
goto err_disable;
|
||||
}
|
||||
|
||||
ucb = kmalloc(sizeof(struct ucb1x00), GFP_KERNEL);
|
||||
ret = -ENOMEM;
|
||||
if (!ucb)
|
||||
goto err_disable;
|
||||
|
||||
memset(ucb, 0, sizeof(struct ucb1x00));
|
||||
|
||||
ucb->cdev.class = &ucb1x00_class;
|
||||
ucb->cdev.dev = &mcp->attached_device;
|
||||
strlcpy(ucb->cdev.class_id, "ucb1x00", sizeof(ucb->cdev.class_id));
|
||||
|
||||
spin_lock_init(&ucb->lock);
|
||||
spin_lock_init(&ucb->io_lock);
|
||||
sema_init(&ucb->adc_sem, 1);
|
||||
|
||||
ucb->id = id;
|
||||
ucb->mcp = mcp;
|
||||
ucb->irq = ucb1x00_detect_irq(ucb);
|
||||
if (ucb->irq == NO_IRQ) {
|
||||
printk(KERN_ERR "UCB1x00: IRQ probe failed\n");
|
||||
ret = -ENODEV;
|
||||
goto err_free;
|
||||
}
|
||||
|
||||
ret = request_irq(ucb->irq, ucb1x00_irq, IRQF_TRIGGER_RISING,
|
||||
"UCB1x00", ucb);
|
||||
if (ret) {
|
||||
printk(KERN_ERR "ucb1x00: unable to grab irq%d: %d\n",
|
||||
ucb->irq, ret);
|
||||
goto err_free;
|
||||
}
|
||||
|
||||
mcp_set_drvdata(mcp, ucb);
|
||||
|
||||
ret = class_device_register(&ucb->cdev);
|
||||
if (ret)
|
||||
goto err_irq;
|
||||
|
||||
INIT_LIST_HEAD(&ucb->devs);
|
||||
mutex_lock(&ucb1x00_mutex);
|
||||
list_add(&ucb->node, &ucb1x00_devices);
|
||||
list_for_each_entry(drv, &ucb1x00_drivers, node) {
|
||||
ucb1x00_add_dev(ucb, drv);
|
||||
}
|
||||
mutex_unlock(&ucb1x00_mutex);
|
||||
goto out;
|
||||
|
||||
err_irq:
|
||||
free_irq(ucb->irq, ucb);
|
||||
err_free:
|
||||
kfree(ucb);
|
||||
err_disable:
|
||||
mcp_disable(mcp);
|
||||
out:
|
||||
return ret;
|
||||
}
|
||||
|
||||
static void ucb1x00_remove(struct mcp *mcp)
|
||||
{
|
||||
struct ucb1x00 *ucb = mcp_get_drvdata(mcp);
|
||||
struct list_head *l, *n;
|
||||
|
||||
mutex_lock(&ucb1x00_mutex);
|
||||
list_del(&ucb->node);
|
||||
list_for_each_safe(l, n, &ucb->devs) {
|
||||
struct ucb1x00_dev *dev = list_entry(l, struct ucb1x00_dev, dev_node);
|
||||
ucb1x00_remove_dev(dev);
|
||||
}
|
||||
mutex_unlock(&ucb1x00_mutex);
|
||||
|
||||
free_irq(ucb->irq, ucb);
|
||||
class_device_unregister(&ucb->cdev);
|
||||
}
|
||||
|
||||
int ucb1x00_register_driver(struct ucb1x00_driver *drv)
|
||||
{
|
||||
struct ucb1x00 *ucb;
|
||||
|
||||
INIT_LIST_HEAD(&drv->devs);
|
||||
mutex_lock(&ucb1x00_mutex);
|
||||
list_add(&drv->node, &ucb1x00_drivers);
|
||||
list_for_each_entry(ucb, &ucb1x00_devices, node) {
|
||||
ucb1x00_add_dev(ucb, drv);
|
||||
}
|
||||
mutex_unlock(&ucb1x00_mutex);
|
||||
return 0;
|
||||
}
|
||||
|
||||
void ucb1x00_unregister_driver(struct ucb1x00_driver *drv)
|
||||
{
|
||||
struct list_head *n, *l;
|
||||
|
||||
mutex_lock(&ucb1x00_mutex);
|
||||
list_del(&drv->node);
|
||||
list_for_each_safe(l, n, &drv->devs) {
|
||||
struct ucb1x00_dev *dev = list_entry(l, struct ucb1x00_dev, drv_node);
|
||||
ucb1x00_remove_dev(dev);
|
||||
}
|
||||
mutex_unlock(&ucb1x00_mutex);
|
||||
}
|
||||
|
||||
static int ucb1x00_suspend(struct mcp *mcp, pm_message_t state)
|
||||
{
|
||||
struct ucb1x00 *ucb = mcp_get_drvdata(mcp);
|
||||
struct ucb1x00_dev *dev;
|
||||
|
||||
mutex_lock(&ucb1x00_mutex);
|
||||
list_for_each_entry(dev, &ucb->devs, dev_node) {
|
||||
if (dev->drv->suspend)
|
||||
dev->drv->suspend(dev, state);
|
||||
}
|
||||
mutex_unlock(&ucb1x00_mutex);
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int ucb1x00_resume(struct mcp *mcp)
|
||||
{
|
||||
struct ucb1x00 *ucb = mcp_get_drvdata(mcp);
|
||||
struct ucb1x00_dev *dev;
|
||||
|
||||
mutex_lock(&ucb1x00_mutex);
|
||||
list_for_each_entry(dev, &ucb->devs, dev_node) {
|
||||
if (dev->drv->resume)
|
||||
dev->drv->resume(dev);
|
||||
}
|
||||
mutex_unlock(&ucb1x00_mutex);
|
||||
return 0;
|
||||
}
|
||||
|
||||
static struct mcp_driver ucb1x00_driver = {
|
||||
.drv = {
|
||||
.name = "ucb1x00",
|
||||
},
|
||||
.probe = ucb1x00_probe,
|
||||
.remove = ucb1x00_remove,
|
||||
.suspend = ucb1x00_suspend,
|
||||
.resume = ucb1x00_resume,
|
||||
};
|
||||
|
||||
static int __init ucb1x00_init(void)
|
||||
{
|
||||
int ret = class_register(&ucb1x00_class);
|
||||
if (ret == 0) {
|
||||
ret = mcp_driver_register(&ucb1x00_driver);
|
||||
if (ret)
|
||||
class_unregister(&ucb1x00_class);
|
||||
}
|
||||
return ret;
|
||||
}
|
||||
|
||||
static void __exit ucb1x00_exit(void)
|
||||
{
|
||||
mcp_driver_unregister(&ucb1x00_driver);
|
||||
class_unregister(&ucb1x00_class);
|
||||
}
|
||||
|
||||
module_init(ucb1x00_init);
|
||||
module_exit(ucb1x00_exit);
|
||||
|
||||
EXPORT_SYMBOL(ucb1x00_io_set_dir);
|
||||
EXPORT_SYMBOL(ucb1x00_io_write);
|
||||
EXPORT_SYMBOL(ucb1x00_io_read);
|
||||
|
||||
EXPORT_SYMBOL(ucb1x00_adc_enable);
|
||||
EXPORT_SYMBOL(ucb1x00_adc_read);
|
||||
EXPORT_SYMBOL(ucb1x00_adc_disable);
|
||||
|
||||
EXPORT_SYMBOL(ucb1x00_hook_irq);
|
||||
EXPORT_SYMBOL(ucb1x00_free_irq);
|
||||
EXPORT_SYMBOL(ucb1x00_enable_irq);
|
||||
EXPORT_SYMBOL(ucb1x00_disable_irq);
|
||||
|
||||
EXPORT_SYMBOL(ucb1x00_register_driver);
|
||||
EXPORT_SYMBOL(ucb1x00_unregister_driver);
|
||||
|
||||
MODULE_AUTHOR("Russell King <rmk@arm.linux.org.uk>");
|
||||
MODULE_DESCRIPTION("UCB1x00 core driver");
|
||||
MODULE_LICENSE("GPL");
|
||||
448
drivers/mfd/ucb1x00-ts.c
Normal file
448
drivers/mfd/ucb1x00-ts.c
Normal file
@@ -0,0 +1,448 @@
|
||||
/*
|
||||
* Touchscreen driver for UCB1x00-based touchscreens
|
||||
*
|
||||
* Copyright (C) 2001 Russell King, All Rights Reserved.
|
||||
* Copyright (C) 2005 Pavel Machek
|
||||
*
|
||||
* This program is free software; you can redistribute it and/or modify
|
||||
* it under the terms of the GNU General Public License version 2 as
|
||||
* published by the Free Software Foundation.
|
||||
*
|
||||
* 21-Jan-2002 <jco@ict.es> :
|
||||
*
|
||||
* Added support for synchronous A/D mode. This mode is useful to
|
||||
* avoid noise induced in the touchpanel by the LCD, provided that
|
||||
* the UCB1x00 has a valid LCD sync signal routed to its ADCSYNC pin.
|
||||
* It is important to note that the signal connected to the ADCSYNC
|
||||
* pin should provide pulses even when the LCD is blanked, otherwise
|
||||
* a pen touch needed to unblank the LCD will never be read.
|
||||
*/
|
||||
#include <linux/module.h>
|
||||
#include <linux/moduleparam.h>
|
||||
#include <linux/init.h>
|
||||
#include <linux/smp.h>
|
||||
#include <linux/smp_lock.h>
|
||||
#include <linux/sched.h>
|
||||
#include <linux/completion.h>
|
||||
#include <linux/delay.h>
|
||||
#include <linux/string.h>
|
||||
#include <linux/input.h>
|
||||
#include <linux/device.h>
|
||||
#include <linux/freezer.h>
|
||||
#include <linux/slab.h>
|
||||
#include <linux/kthread.h>
|
||||
|
||||
#include <asm/dma.h>
|
||||
#include <asm/semaphore.h>
|
||||
#include <asm/arch/collie.h>
|
||||
#include <asm/mach-types.h>
|
||||
|
||||
#include "ucb1x00.h"
|
||||
|
||||
|
||||
struct ucb1x00_ts {
|
||||
struct input_dev *idev;
|
||||
struct ucb1x00 *ucb;
|
||||
|
||||
wait_queue_head_t irq_wait;
|
||||
struct task_struct *rtask;
|
||||
u16 x_res;
|
||||
u16 y_res;
|
||||
|
||||
unsigned int restart:1;
|
||||
unsigned int adcsync:1;
|
||||
};
|
||||
|
||||
static int adcsync;
|
||||
|
||||
static inline void ucb1x00_ts_evt_add(struct ucb1x00_ts *ts, u16 pressure, u16 x, u16 y)
|
||||
{
|
||||
struct input_dev *idev = ts->idev;
|
||||
|
||||
input_report_abs(idev, ABS_X, x);
|
||||
input_report_abs(idev, ABS_Y, y);
|
||||
input_report_abs(idev, ABS_PRESSURE, pressure);
|
||||
input_sync(idev);
|
||||
}
|
||||
|
||||
static inline void ucb1x00_ts_event_release(struct ucb1x00_ts *ts)
|
||||
{
|
||||
struct input_dev *idev = ts->idev;
|
||||
|
||||
input_report_abs(idev, ABS_PRESSURE, 0);
|
||||
input_sync(idev);
|
||||
}
|
||||
|
||||
/*
|
||||
* Switch to interrupt mode.
|
||||
*/
|
||||
static inline void ucb1x00_ts_mode_int(struct ucb1x00_ts *ts)
|
||||
{
|
||||
ucb1x00_reg_write(ts->ucb, UCB_TS_CR,
|
||||
UCB_TS_CR_TSMX_POW | UCB_TS_CR_TSPX_POW |
|
||||
UCB_TS_CR_TSMY_GND | UCB_TS_CR_TSPY_GND |
|
||||
UCB_TS_CR_MODE_INT);
|
||||
}
|
||||
|
||||
/*
|
||||
* Switch to pressure mode, and read pressure. We don't need to wait
|
||||
* here, since both plates are being driven.
|
||||
*/
|
||||
static inline unsigned int ucb1x00_ts_read_pressure(struct ucb1x00_ts *ts)
|
||||
{
|
||||
if (machine_is_collie()) {
|
||||
ucb1x00_io_write(ts->ucb, COLLIE_TC35143_GPIO_TBL_CHK, 0);
|
||||
ucb1x00_reg_write(ts->ucb, UCB_TS_CR,
|
||||
UCB_TS_CR_TSPX_POW | UCB_TS_CR_TSMX_POW |
|
||||
UCB_TS_CR_MODE_POS | UCB_TS_CR_BIAS_ENA);
|
||||
|
||||
udelay(55);
|
||||
|
||||
return ucb1x00_adc_read(ts->ucb, UCB_ADC_INP_AD2, ts->adcsync);
|
||||
} else {
|
||||
ucb1x00_reg_write(ts->ucb, UCB_TS_CR,
|
||||
UCB_TS_CR_TSMX_POW | UCB_TS_CR_TSPX_POW |
|
||||
UCB_TS_CR_TSMY_GND | UCB_TS_CR_TSPY_GND |
|
||||
UCB_TS_CR_MODE_PRES | UCB_TS_CR_BIAS_ENA);
|
||||
|
||||
return ucb1x00_adc_read(ts->ucb, UCB_ADC_INP_TSPY, ts->adcsync);
|
||||
}
|
||||
}
|
||||
|
||||
/*
|
||||
* Switch to X position mode and measure Y plate. We switch the plate
|
||||
* configuration in pressure mode, then switch to position mode. This
|
||||
* gives a faster response time. Even so, we need to wait about 55us
|
||||
* for things to stabilise.
|
||||
*/
|
||||
static inline unsigned int ucb1x00_ts_read_xpos(struct ucb1x00_ts *ts)
|
||||
{
|
||||
if (machine_is_collie())
|
||||
ucb1x00_io_write(ts->ucb, 0, COLLIE_TC35143_GPIO_TBL_CHK);
|
||||
else {
|
||||
ucb1x00_reg_write(ts->ucb, UCB_TS_CR,
|
||||
UCB_TS_CR_TSMX_GND | UCB_TS_CR_TSPX_POW |
|
||||
UCB_TS_CR_MODE_PRES | UCB_TS_CR_BIAS_ENA);
|
||||
ucb1x00_reg_write(ts->ucb, UCB_TS_CR,
|
||||
UCB_TS_CR_TSMX_GND | UCB_TS_CR_TSPX_POW |
|
||||
UCB_TS_CR_MODE_PRES | UCB_TS_CR_BIAS_ENA);
|
||||
}
|
||||
ucb1x00_reg_write(ts->ucb, UCB_TS_CR,
|
||||
UCB_TS_CR_TSMX_GND | UCB_TS_CR_TSPX_POW |
|
||||
UCB_TS_CR_MODE_POS | UCB_TS_CR_BIAS_ENA);
|
||||
|
||||
udelay(55);
|
||||
|
||||
return ucb1x00_adc_read(ts->ucb, UCB_ADC_INP_TSPY, ts->adcsync);
|
||||
}
|
||||
|
||||
/*
|
||||
* Switch to Y position mode and measure X plate. We switch the plate
|
||||
* configuration in pressure mode, then switch to position mode. This
|
||||
* gives a faster response time. Even so, we need to wait about 55us
|
||||
* for things to stabilise.
|
||||
*/
|
||||
static inline unsigned int ucb1x00_ts_read_ypos(struct ucb1x00_ts *ts)
|
||||
{
|
||||
if (machine_is_collie())
|
||||
ucb1x00_io_write(ts->ucb, 0, COLLIE_TC35143_GPIO_TBL_CHK);
|
||||
else {
|
||||
ucb1x00_reg_write(ts->ucb, UCB_TS_CR,
|
||||
UCB_TS_CR_TSMY_GND | UCB_TS_CR_TSPY_POW |
|
||||
UCB_TS_CR_MODE_PRES | UCB_TS_CR_BIAS_ENA);
|
||||
ucb1x00_reg_write(ts->ucb, UCB_TS_CR,
|
||||
UCB_TS_CR_TSMY_GND | UCB_TS_CR_TSPY_POW |
|
||||
UCB_TS_CR_MODE_PRES | UCB_TS_CR_BIAS_ENA);
|
||||
}
|
||||
|
||||
ucb1x00_reg_write(ts->ucb, UCB_TS_CR,
|
||||
UCB_TS_CR_TSMY_GND | UCB_TS_CR_TSPY_POW |
|
||||
UCB_TS_CR_MODE_POS | UCB_TS_CR_BIAS_ENA);
|
||||
|
||||
udelay(55);
|
||||
|
||||
return ucb1x00_adc_read(ts->ucb, UCB_ADC_INP_TSPX, ts->adcsync);
|
||||
}
|
||||
|
||||
/*
|
||||
* Switch to X plate resistance mode. Set MX to ground, PX to
|
||||
* supply. Measure current.
|
||||
*/
|
||||
static inline unsigned int ucb1x00_ts_read_xres(struct ucb1x00_ts *ts)
|
||||
{
|
||||
ucb1x00_reg_write(ts->ucb, UCB_TS_CR,
|
||||
UCB_TS_CR_TSMX_GND | UCB_TS_CR_TSPX_POW |
|
||||
UCB_TS_CR_MODE_PRES | UCB_TS_CR_BIAS_ENA);
|
||||
return ucb1x00_adc_read(ts->ucb, 0, ts->adcsync);
|
||||
}
|
||||
|
||||
/*
|
||||
* Switch to Y plate resistance mode. Set MY to ground, PY to
|
||||
* supply. Measure current.
|
||||
*/
|
||||
static inline unsigned int ucb1x00_ts_read_yres(struct ucb1x00_ts *ts)
|
||||
{
|
||||
ucb1x00_reg_write(ts->ucb, UCB_TS_CR,
|
||||
UCB_TS_CR_TSMY_GND | UCB_TS_CR_TSPY_POW |
|
||||
UCB_TS_CR_MODE_PRES | UCB_TS_CR_BIAS_ENA);
|
||||
return ucb1x00_adc_read(ts->ucb, 0, ts->adcsync);
|
||||
}
|
||||
|
||||
static inline int ucb1x00_ts_pen_down(struct ucb1x00_ts *ts)
|
||||
{
|
||||
unsigned int val = ucb1x00_reg_read(ts->ucb, UCB_TS_CR);
|
||||
|
||||
if (machine_is_collie())
|
||||
return (!(val & (UCB_TS_CR_TSPX_LOW)));
|
||||
else
|
||||
return (val & (UCB_TS_CR_TSPX_LOW | UCB_TS_CR_TSMX_LOW));
|
||||
}
|
||||
|
||||
/*
|
||||
* This is a RT kernel thread that handles the ADC accesses
|
||||
* (mainly so we can use semaphores in the UCB1200 core code
|
||||
* to serialise accesses to the ADC).
|
||||
*/
|
||||
static int ucb1x00_thread(void *_ts)
|
||||
{
|
||||
struct ucb1x00_ts *ts = _ts;
|
||||
struct task_struct *tsk = current;
|
||||
DECLARE_WAITQUEUE(wait, tsk);
|
||||
int valid;
|
||||
|
||||
/*
|
||||
* We could run as a real-time thread. However, thus far
|
||||
* this doesn't seem to be necessary.
|
||||
*/
|
||||
// tsk->policy = SCHED_FIFO;
|
||||
// tsk->rt_priority = 1;
|
||||
|
||||
valid = 0;
|
||||
|
||||
add_wait_queue(&ts->irq_wait, &wait);
|
||||
while (!kthread_should_stop()) {
|
||||
unsigned int x, y, p;
|
||||
signed long timeout;
|
||||
|
||||
ts->restart = 0;
|
||||
|
||||
ucb1x00_adc_enable(ts->ucb);
|
||||
|
||||
x = ucb1x00_ts_read_xpos(ts);
|
||||
y = ucb1x00_ts_read_ypos(ts);
|
||||
p = ucb1x00_ts_read_pressure(ts);
|
||||
|
||||
/*
|
||||
* Switch back to interrupt mode.
|
||||
*/
|
||||
ucb1x00_ts_mode_int(ts);
|
||||
ucb1x00_adc_disable(ts->ucb);
|
||||
|
||||
msleep(10);
|
||||
|
||||
ucb1x00_enable(ts->ucb);
|
||||
|
||||
|
||||
if (ucb1x00_ts_pen_down(ts)) {
|
||||
set_task_state(tsk, TASK_INTERRUPTIBLE);
|
||||
|
||||
ucb1x00_enable_irq(ts->ucb, UCB_IRQ_TSPX, machine_is_collie() ? UCB_RISING : UCB_FALLING);
|
||||
ucb1x00_disable(ts->ucb);
|
||||
|
||||
/*
|
||||
* If we spat out a valid sample set last time,
|
||||
* spit out a "pen off" sample here.
|
||||
*/
|
||||
if (valid) {
|
||||
ucb1x00_ts_event_release(ts);
|
||||
valid = 0;
|
||||
}
|
||||
|
||||
timeout = MAX_SCHEDULE_TIMEOUT;
|
||||
} else {
|
||||
ucb1x00_disable(ts->ucb);
|
||||
|
||||
/*
|
||||
* Filtering is policy. Policy belongs in user
|
||||
* space. We therefore leave it to user space
|
||||
* to do any filtering they please.
|
||||
*/
|
||||
if (!ts->restart) {
|
||||
ucb1x00_ts_evt_add(ts, p, x, y);
|
||||
valid = 1;
|
||||
}
|
||||
|
||||
set_task_state(tsk, TASK_INTERRUPTIBLE);
|
||||
timeout = HZ / 100;
|
||||
}
|
||||
|
||||
try_to_freeze();
|
||||
|
||||
schedule_timeout(timeout);
|
||||
}
|
||||
|
||||
remove_wait_queue(&ts->irq_wait, &wait);
|
||||
|
||||
ts->rtask = NULL;
|
||||
return 0;
|
||||
}
|
||||
|
||||
/*
|
||||
* We only detect touch screen _touches_ with this interrupt
|
||||
* handler, and even then we just schedule our task.
|
||||
*/
|
||||
static void ucb1x00_ts_irq(int idx, void *id)
|
||||
{
|
||||
struct ucb1x00_ts *ts = id;
|
||||
|
||||
ucb1x00_disable_irq(ts->ucb, UCB_IRQ_TSPX, UCB_FALLING);
|
||||
wake_up(&ts->irq_wait);
|
||||
}
|
||||
|
||||
static int ucb1x00_ts_open(struct input_dev *idev)
|
||||
{
|
||||
struct ucb1x00_ts *ts = idev->private;
|
||||
int ret = 0;
|
||||
|
||||
BUG_ON(ts->rtask);
|
||||
|
||||
init_waitqueue_head(&ts->irq_wait);
|
||||
ret = ucb1x00_hook_irq(ts->ucb, UCB_IRQ_TSPX, ucb1x00_ts_irq, ts);
|
||||
if (ret < 0)
|
||||
goto out;
|
||||
|
||||
/*
|
||||
* If we do this at all, we should allow the user to
|
||||
* measure and read the X and Y resistance at any time.
|
||||
*/
|
||||
ucb1x00_adc_enable(ts->ucb);
|
||||
ts->x_res = ucb1x00_ts_read_xres(ts);
|
||||
ts->y_res = ucb1x00_ts_read_yres(ts);
|
||||
ucb1x00_adc_disable(ts->ucb);
|
||||
|
||||
ts->rtask = kthread_run(ucb1x00_thread, ts, "ktsd");
|
||||
if (!IS_ERR(ts->rtask)) {
|
||||
ret = 0;
|
||||
} else {
|
||||
ucb1x00_free_irq(ts->ucb, UCB_IRQ_TSPX, ts);
|
||||
ts->rtask = NULL;
|
||||
ret = -EFAULT;
|
||||
}
|
||||
|
||||
out:
|
||||
return ret;
|
||||
}
|
||||
|
||||
/*
|
||||
* Release touchscreen resources. Disable IRQs.
|
||||
*/
|
||||
static void ucb1x00_ts_close(struct input_dev *idev)
|
||||
{
|
||||
struct ucb1x00_ts *ts = idev->private;
|
||||
|
||||
if (ts->rtask)
|
||||
kthread_stop(ts->rtask);
|
||||
|
||||
ucb1x00_enable(ts->ucb);
|
||||
ucb1x00_free_irq(ts->ucb, UCB_IRQ_TSPX, ts);
|
||||
ucb1x00_reg_write(ts->ucb, UCB_TS_CR, 0);
|
||||
ucb1x00_disable(ts->ucb);
|
||||
}
|
||||
|
||||
#ifdef CONFIG_PM
|
||||
static int ucb1x00_ts_resume(struct ucb1x00_dev *dev)
|
||||
{
|
||||
struct ucb1x00_ts *ts = dev->priv;
|
||||
|
||||
if (ts->rtask != NULL) {
|
||||
/*
|
||||
* Restart the TS thread to ensure the
|
||||
* TS interrupt mode is set up again
|
||||
* after sleep.
|
||||
*/
|
||||
ts->restart = 1;
|
||||
wake_up(&ts->irq_wait);
|
||||
}
|
||||
return 0;
|
||||
}
|
||||
#else
|
||||
#define ucb1x00_ts_resume NULL
|
||||
#endif
|
||||
|
||||
|
||||
/*
|
||||
* Initialisation.
|
||||
*/
|
||||
static int ucb1x00_ts_add(struct ucb1x00_dev *dev)
|
||||
{
|
||||
struct ucb1x00_ts *ts;
|
||||
struct input_dev *idev;
|
||||
int err;
|
||||
|
||||
ts = kzalloc(sizeof(struct ucb1x00_ts), GFP_KERNEL);
|
||||
idev = input_allocate_device();
|
||||
if (!ts || !idev) {
|
||||
err = -ENOMEM;
|
||||
goto fail;
|
||||
}
|
||||
|
||||
ts->ucb = dev->ucb;
|
||||
ts->idev = idev;
|
||||
ts->adcsync = adcsync ? UCB_SYNC : UCB_NOSYNC;
|
||||
|
||||
idev->private = ts;
|
||||
idev->name = "Touchscreen panel";
|
||||
idev->id.product = ts->ucb->id;
|
||||
idev->open = ucb1x00_ts_open;
|
||||
idev->close = ucb1x00_ts_close;
|
||||
|
||||
__set_bit(EV_ABS, idev->evbit);
|
||||
__set_bit(ABS_X, idev->absbit);
|
||||
__set_bit(ABS_Y, idev->absbit);
|
||||
__set_bit(ABS_PRESSURE, idev->absbit);
|
||||
|
||||
err = input_register_device(idev);
|
||||
if (err)
|
||||
goto fail;
|
||||
|
||||
dev->priv = ts;
|
||||
|
||||
return 0;
|
||||
|
||||
fail:
|
||||
input_free_device(idev);
|
||||
kfree(ts);
|
||||
return err;
|
||||
}
|
||||
|
||||
static void ucb1x00_ts_remove(struct ucb1x00_dev *dev)
|
||||
{
|
||||
struct ucb1x00_ts *ts = dev->priv;
|
||||
|
||||
input_unregister_device(ts->idev);
|
||||
kfree(ts);
|
||||
}
|
||||
|
||||
static struct ucb1x00_driver ucb1x00_ts_driver = {
|
||||
.add = ucb1x00_ts_add,
|
||||
.remove = ucb1x00_ts_remove,
|
||||
.resume = ucb1x00_ts_resume,
|
||||
};
|
||||
|
||||
static int __init ucb1x00_ts_init(void)
|
||||
{
|
||||
return ucb1x00_register_driver(&ucb1x00_ts_driver);
|
||||
}
|
||||
|
||||
static void __exit ucb1x00_ts_exit(void)
|
||||
{
|
||||
ucb1x00_unregister_driver(&ucb1x00_ts_driver);
|
||||
}
|
||||
|
||||
module_param(adcsync, int, 0444);
|
||||
module_init(ucb1x00_ts_init);
|
||||
module_exit(ucb1x00_ts_exit);
|
||||
|
||||
MODULE_AUTHOR("Russell King <rmk@arm.linux.org.uk>");
|
||||
MODULE_DESCRIPTION("UCB1x00 touchscreen driver");
|
||||
MODULE_LICENSE("GPL");
|
||||
255
drivers/mfd/ucb1x00.h
Normal file
255
drivers/mfd/ucb1x00.h
Normal file
@@ -0,0 +1,255 @@
|
||||
/*
|
||||
* linux/drivers/mfd/ucb1x00.h
|
||||
*
|
||||
* Copyright (C) 2001 Russell King, All Rights Reserved.
|
||||
*
|
||||
* 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.
|
||||
*/
|
||||
#ifndef UCB1200_H
|
||||
#define UCB1200_H
|
||||
|
||||
#define UCB_IO_DATA 0x00
|
||||
#define UCB_IO_DIR 0x01
|
||||
|
||||
#define UCB_IO_0 (1 << 0)
|
||||
#define UCB_IO_1 (1 << 1)
|
||||
#define UCB_IO_2 (1 << 2)
|
||||
#define UCB_IO_3 (1 << 3)
|
||||
#define UCB_IO_4 (1 << 4)
|
||||
#define UCB_IO_5 (1 << 5)
|
||||
#define UCB_IO_6 (1 << 6)
|
||||
#define UCB_IO_7 (1 << 7)
|
||||
#define UCB_IO_8 (1 << 8)
|
||||
#define UCB_IO_9 (1 << 9)
|
||||
|
||||
#define UCB_IE_RIS 0x02
|
||||
#define UCB_IE_FAL 0x03
|
||||
#define UCB_IE_STATUS 0x04
|
||||
#define UCB_IE_CLEAR 0x04
|
||||
#define UCB_IE_ADC (1 << 11)
|
||||
#define UCB_IE_TSPX (1 << 12)
|
||||
#define UCB_IE_TSMX (1 << 13)
|
||||
#define UCB_IE_TCLIP (1 << 14)
|
||||
#define UCB_IE_ACLIP (1 << 15)
|
||||
|
||||
#define UCB_IRQ_TSPX 12
|
||||
|
||||
#define UCB_TC_A 0x05
|
||||
#define UCB_TC_A_LOOP (1 << 7) /* UCB1200 */
|
||||
#define UCB_TC_A_AMPL (1 << 7) /* UCB1300 */
|
||||
|
||||
#define UCB_TC_B 0x06
|
||||
#define UCB_TC_B_VOICE_ENA (1 << 3)
|
||||
#define UCB_TC_B_CLIP (1 << 4)
|
||||
#define UCB_TC_B_ATT (1 << 6)
|
||||
#define UCB_TC_B_SIDE_ENA (1 << 11)
|
||||
#define UCB_TC_B_MUTE (1 << 13)
|
||||
#define UCB_TC_B_IN_ENA (1 << 14)
|
||||
#define UCB_TC_B_OUT_ENA (1 << 15)
|
||||
|
||||
#define UCB_AC_A 0x07
|
||||
#define UCB_AC_B 0x08
|
||||
#define UCB_AC_B_LOOP (1 << 8)
|
||||
#define UCB_AC_B_MUTE (1 << 13)
|
||||
#define UCB_AC_B_IN_ENA (1 << 14)
|
||||
#define UCB_AC_B_OUT_ENA (1 << 15)
|
||||
|
||||
#define UCB_TS_CR 0x09
|
||||
#define UCB_TS_CR_TSMX_POW (1 << 0)
|
||||
#define UCB_TS_CR_TSPX_POW (1 << 1)
|
||||
#define UCB_TS_CR_TSMY_POW (1 << 2)
|
||||
#define UCB_TS_CR_TSPY_POW (1 << 3)
|
||||
#define UCB_TS_CR_TSMX_GND (1 << 4)
|
||||
#define UCB_TS_CR_TSPX_GND (1 << 5)
|
||||
#define UCB_TS_CR_TSMY_GND (1 << 6)
|
||||
#define UCB_TS_CR_TSPY_GND (1 << 7)
|
||||
#define UCB_TS_CR_MODE_INT (0 << 8)
|
||||
#define UCB_TS_CR_MODE_PRES (1 << 8)
|
||||
#define UCB_TS_CR_MODE_POS (2 << 8)
|
||||
#define UCB_TS_CR_BIAS_ENA (1 << 11)
|
||||
#define UCB_TS_CR_TSPX_LOW (1 << 12)
|
||||
#define UCB_TS_CR_TSMX_LOW (1 << 13)
|
||||
|
||||
#define UCB_ADC_CR 0x0a
|
||||
#define UCB_ADC_SYNC_ENA (1 << 0)
|
||||
#define UCB_ADC_VREFBYP_CON (1 << 1)
|
||||
#define UCB_ADC_INP_TSPX (0 << 2)
|
||||
#define UCB_ADC_INP_TSMX (1 << 2)
|
||||
#define UCB_ADC_INP_TSPY (2 << 2)
|
||||
#define UCB_ADC_INP_TSMY (3 << 2)
|
||||
#define UCB_ADC_INP_AD0 (4 << 2)
|
||||
#define UCB_ADC_INP_AD1 (5 << 2)
|
||||
#define UCB_ADC_INP_AD2 (6 << 2)
|
||||
#define UCB_ADC_INP_AD3 (7 << 2)
|
||||
#define UCB_ADC_EXT_REF (1 << 5)
|
||||
#define UCB_ADC_START (1 << 7)
|
||||
#define UCB_ADC_ENA (1 << 15)
|
||||
|
||||
#define UCB_ADC_DATA 0x0b
|
||||
#define UCB_ADC_DAT_VAL (1 << 15)
|
||||
#define UCB_ADC_DAT(x) (((x) & 0x7fe0) >> 5)
|
||||
|
||||
#define UCB_ID 0x0c
|
||||
#define UCB_ID_1200 0x1004
|
||||
#define UCB_ID_1300 0x1005
|
||||
#define UCB_ID_TC35143 0x9712
|
||||
|
||||
#define UCB_MODE 0x0d
|
||||
#define UCB_MODE_DYN_VFLAG_ENA (1 << 12)
|
||||
#define UCB_MODE_AUD_OFF_CAN (1 << 13)
|
||||
|
||||
#include "mcp.h"
|
||||
|
||||
struct ucb1x00_irq {
|
||||
void *devid;
|
||||
void (*fn)(int, void *);
|
||||
};
|
||||
|
||||
struct ucb1x00 {
|
||||
spinlock_t lock;
|
||||
struct mcp *mcp;
|
||||
unsigned int irq;
|
||||
struct semaphore adc_sem;
|
||||
spinlock_t io_lock;
|
||||
u16 id;
|
||||
u16 io_dir;
|
||||
u16 io_out;
|
||||
u16 adc_cr;
|
||||
u16 irq_fal_enbl;
|
||||
u16 irq_ris_enbl;
|
||||
struct ucb1x00_irq irq_handler[16];
|
||||
struct class_device cdev;
|
||||
struct list_head node;
|
||||
struct list_head devs;
|
||||
};
|
||||
|
||||
struct ucb1x00_driver;
|
||||
|
||||
struct ucb1x00_dev {
|
||||
struct list_head dev_node;
|
||||
struct list_head drv_node;
|
||||
struct ucb1x00 *ucb;
|
||||
struct ucb1x00_driver *drv;
|
||||
void *priv;
|
||||
};
|
||||
|
||||
struct ucb1x00_driver {
|
||||
struct list_head node;
|
||||
struct list_head devs;
|
||||
int (*add)(struct ucb1x00_dev *dev);
|
||||
void (*remove)(struct ucb1x00_dev *dev);
|
||||
int (*suspend)(struct ucb1x00_dev *dev, pm_message_t state);
|
||||
int (*resume)(struct ucb1x00_dev *dev);
|
||||
};
|
||||
|
||||
#define classdev_to_ucb1x00(cd) container_of(cd, struct ucb1x00, cdev)
|
||||
|
||||
int ucb1x00_register_driver(struct ucb1x00_driver *);
|
||||
void ucb1x00_unregister_driver(struct ucb1x00_driver *);
|
||||
|
||||
/**
|
||||
* ucb1x00_clkrate - return the UCB1x00 SIB clock rate
|
||||
* @ucb: UCB1x00 structure describing chip
|
||||
*
|
||||
* Return the SIB clock rate in Hz.
|
||||
*/
|
||||
static inline unsigned int ucb1x00_clkrate(struct ucb1x00 *ucb)
|
||||
{
|
||||
return mcp_get_sclk_rate(ucb->mcp);
|
||||
}
|
||||
|
||||
/**
|
||||
* ucb1x00_enable - enable the UCB1x00 SIB clock
|
||||
* @ucb: UCB1x00 structure describing chip
|
||||
*
|
||||
* Enable the SIB clock. This can be called multiple times.
|
||||
*/
|
||||
static inline void ucb1x00_enable(struct ucb1x00 *ucb)
|
||||
{
|
||||
mcp_enable(ucb->mcp);
|
||||
}
|
||||
|
||||
/**
|
||||
* ucb1x00_disable - disable the UCB1x00 SIB clock
|
||||
* @ucb: UCB1x00 structure describing chip
|
||||
*
|
||||
* Disable the SIB clock. The SIB clock will only be disabled
|
||||
* when the number of ucb1x00_enable calls match the number of
|
||||
* ucb1x00_disable calls.
|
||||
*/
|
||||
static inline void ucb1x00_disable(struct ucb1x00 *ucb)
|
||||
{
|
||||
mcp_disable(ucb->mcp);
|
||||
}
|
||||
|
||||
/**
|
||||
* ucb1x00_reg_write - write a UCB1x00 register
|
||||
* @ucb: UCB1x00 structure describing chip
|
||||
* @reg: UCB1x00 4-bit register index to write
|
||||
* @val: UCB1x00 16-bit value to write
|
||||
*
|
||||
* Write the UCB1x00 register @reg with value @val. The SIB
|
||||
* clock must be running for this function to return.
|
||||
*/
|
||||
static inline void ucb1x00_reg_write(struct ucb1x00 *ucb, unsigned int reg, unsigned int val)
|
||||
{
|
||||
mcp_reg_write(ucb->mcp, reg, val);
|
||||
}
|
||||
|
||||
/**
|
||||
* ucb1x00_reg_read - read a UCB1x00 register
|
||||
* @ucb: UCB1x00 structure describing chip
|
||||
* @reg: UCB1x00 4-bit register index to write
|
||||
*
|
||||
* Read the UCB1x00 register @reg and return its value. The SIB
|
||||
* clock must be running for this function to return.
|
||||
*/
|
||||
static inline unsigned int ucb1x00_reg_read(struct ucb1x00 *ucb, unsigned int reg)
|
||||
{
|
||||
return mcp_reg_read(ucb->mcp, reg);
|
||||
}
|
||||
/**
|
||||
* ucb1x00_set_audio_divisor -
|
||||
* @ucb: UCB1x00 structure describing chip
|
||||
* @div: SIB clock divisor
|
||||
*/
|
||||
static inline void ucb1x00_set_audio_divisor(struct ucb1x00 *ucb, unsigned int div)
|
||||
{
|
||||
mcp_set_audio_divisor(ucb->mcp, div);
|
||||
}
|
||||
|
||||
/**
|
||||
* ucb1x00_set_telecom_divisor -
|
||||
* @ucb: UCB1x00 structure describing chip
|
||||
* @div: SIB clock divisor
|
||||
*/
|
||||
static inline void ucb1x00_set_telecom_divisor(struct ucb1x00 *ucb, unsigned int div)
|
||||
{
|
||||
mcp_set_telecom_divisor(ucb->mcp, div);
|
||||
}
|
||||
|
||||
void ucb1x00_io_set_dir(struct ucb1x00 *ucb, unsigned int, unsigned int);
|
||||
void ucb1x00_io_write(struct ucb1x00 *ucb, unsigned int, unsigned int);
|
||||
unsigned int ucb1x00_io_read(struct ucb1x00 *ucb);
|
||||
|
||||
#define UCB_NOSYNC (0)
|
||||
#define UCB_SYNC (1)
|
||||
|
||||
unsigned int ucb1x00_adc_read(struct ucb1x00 *ucb, int adc_channel, int sync);
|
||||
void ucb1x00_adc_enable(struct ucb1x00 *ucb);
|
||||
void ucb1x00_adc_disable(struct ucb1x00 *ucb);
|
||||
|
||||
/*
|
||||
* Which edges of the IRQ do you want to control today?
|
||||
*/
|
||||
#define UCB_RISING (1 << 0)
|
||||
#define UCB_FALLING (1 << 1)
|
||||
|
||||
int ucb1x00_hook_irq(struct ucb1x00 *ucb, unsigned int idx, void (*fn)(int, void *), void *devid);
|
||||
void ucb1x00_enable_irq(struct ucb1x00 *ucb, unsigned int idx, int edges);
|
||||
void ucb1x00_disable_irq(struct ucb1x00 *ucb, unsigned int idx, int edges);
|
||||
int ucb1x00_free_irq(struct ucb1x00 *ucb, unsigned int idx, void *devid);
|
||||
|
||||
#endif
|
||||
Reference in New Issue
Block a user