mirror of
https://github.com/AetherDroid/android_kernel_samsung_on5xelte.git
synced 2025-09-09 01:28:05 -04:00
Fixed MTP to work with TWRP
This commit is contained in:
awab228
commit
f6dfaef42e
50820 changed files with 20846062 additions and 0 deletions
261
drivers/input/serio/ct82c710.c
Normal file
261
drivers/input/serio/ct82c710.c
Normal file
|
|
@ -0,0 +1,261 @@
|
|||
/*
|
||||
* Copyright (c) 1999-2001 Vojtech Pavlik
|
||||
*/
|
||||
|
||||
/*
|
||||
* 82C710 C&T mouse port chip driver for Linux
|
||||
*/
|
||||
|
||||
/*
|
||||
* 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.
|
||||
*
|
||||
* This program is distributed in the hope that it will be useful,
|
||||
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
||||
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
||||
* GNU General Public License for more details.
|
||||
*
|
||||
* You should have received a copy of the GNU General Public License
|
||||
* along with this program; if not, write to the Free Software
|
||||
* Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
|
||||
*
|
||||
* Should you need to contact me, the author, you can do so either by
|
||||
* e-mail - mail your message to <vojtech@ucw.cz>, or by paper mail:
|
||||
* Vojtech Pavlik, Simunkova 1594, Prague 8, 182 00 Czech Republic
|
||||
*/
|
||||
|
||||
#include <linux/delay.h>
|
||||
#include <linux/module.h>
|
||||
#include <linux/ioport.h>
|
||||
#include <linux/init.h>
|
||||
#include <linux/interrupt.h>
|
||||
#include <linux/serio.h>
|
||||
#include <linux/errno.h>
|
||||
#include <linux/err.h>
|
||||
#include <linux/platform_device.h>
|
||||
#include <linux/slab.h>
|
||||
|
||||
#include <asm/io.h>
|
||||
|
||||
MODULE_AUTHOR("Vojtech Pavlik <vojtech@ucw.cz>");
|
||||
MODULE_DESCRIPTION("82C710 C&T mouse port chip driver");
|
||||
MODULE_LICENSE("GPL");
|
||||
|
||||
/*
|
||||
* ct82c710 interface
|
||||
*/
|
||||
|
||||
#define CT82C710_DEV_IDLE 0x01 /* Device Idle */
|
||||
#define CT82C710_RX_FULL 0x02 /* Device Char received */
|
||||
#define CT82C710_TX_IDLE 0x04 /* Device XMIT Idle */
|
||||
#define CT82C710_RESET 0x08 /* Device Reset */
|
||||
#define CT82C710_INTS_ON 0x10 /* Device Interrupt On */
|
||||
#define CT82C710_ERROR_FLAG 0x20 /* Device Error */
|
||||
#define CT82C710_CLEAR 0x40 /* Device Clear */
|
||||
#define CT82C710_ENABLE 0x80 /* Device Enable */
|
||||
|
||||
#define CT82C710_IRQ 12
|
||||
|
||||
#define CT82C710_DATA ct82c710_iores.start
|
||||
#define CT82C710_STATUS (ct82c710_iores.start + 1)
|
||||
|
||||
static struct serio *ct82c710_port;
|
||||
static struct platform_device *ct82c710_device;
|
||||
static struct resource ct82c710_iores;
|
||||
|
||||
/*
|
||||
* Interrupt handler for the 82C710 mouse port. A character
|
||||
* is waiting in the 82C710.
|
||||
*/
|
||||
|
||||
static irqreturn_t ct82c710_interrupt(int cpl, void *dev_id)
|
||||
{
|
||||
return serio_interrupt(ct82c710_port, inb(CT82C710_DATA), 0);
|
||||
}
|
||||
|
||||
/*
|
||||
* Wait for device to send output char and flush any input char.
|
||||
*/
|
||||
|
||||
static int ct82c170_wait(void)
|
||||
{
|
||||
int timeout = 60000;
|
||||
|
||||
while ((inb(CT82C710_STATUS) & (CT82C710_RX_FULL | CT82C710_TX_IDLE | CT82C710_DEV_IDLE))
|
||||
!= (CT82C710_DEV_IDLE | CT82C710_TX_IDLE) && timeout) {
|
||||
|
||||
if (inb_p(CT82C710_STATUS) & CT82C710_RX_FULL) inb_p(CT82C710_DATA);
|
||||
|
||||
udelay(1);
|
||||
timeout--;
|
||||
}
|
||||
|
||||
return !timeout;
|
||||
}
|
||||
|
||||
static void ct82c710_close(struct serio *serio)
|
||||
{
|
||||
if (ct82c170_wait())
|
||||
printk(KERN_WARNING "ct82c710.c: Device busy in close()\n");
|
||||
|
||||
outb_p(inb_p(CT82C710_STATUS) & ~(CT82C710_ENABLE | CT82C710_INTS_ON), CT82C710_STATUS);
|
||||
|
||||
if (ct82c170_wait())
|
||||
printk(KERN_WARNING "ct82c710.c: Device busy in close()\n");
|
||||
|
||||
free_irq(CT82C710_IRQ, NULL);
|
||||
}
|
||||
|
||||
static int ct82c710_open(struct serio *serio)
|
||||
{
|
||||
unsigned char status;
|
||||
int err;
|
||||
|
||||
err = request_irq(CT82C710_IRQ, ct82c710_interrupt, 0, "ct82c710", NULL);
|
||||
if (err)
|
||||
return err;
|
||||
|
||||
status = inb_p(CT82C710_STATUS);
|
||||
|
||||
status |= (CT82C710_ENABLE | CT82C710_RESET);
|
||||
outb_p(status, CT82C710_STATUS);
|
||||
|
||||
status &= ~(CT82C710_RESET);
|
||||
outb_p(status, CT82C710_STATUS);
|
||||
|
||||
status |= CT82C710_INTS_ON;
|
||||
outb_p(status, CT82C710_STATUS); /* Enable interrupts */
|
||||
|
||||
while (ct82c170_wait()) {
|
||||
printk(KERN_ERR "ct82c710: Device busy in open()\n");
|
||||
status &= ~(CT82C710_ENABLE | CT82C710_INTS_ON);
|
||||
outb_p(status, CT82C710_STATUS);
|
||||
free_irq(CT82C710_IRQ, NULL);
|
||||
return -EBUSY;
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
/*
|
||||
* Write to the 82C710 mouse device.
|
||||
*/
|
||||
|
||||
static int ct82c710_write(struct serio *port, unsigned char c)
|
||||
{
|
||||
if (ct82c170_wait()) return -1;
|
||||
outb_p(c, CT82C710_DATA);
|
||||
return 0;
|
||||
}
|
||||
|
||||
/*
|
||||
* See if we can find a 82C710 device. Read mouse address.
|
||||
*/
|
||||
|
||||
static int __init ct82c710_detect(void)
|
||||
{
|
||||
outb_p(0x55, 0x2fa); /* Any value except 9, ff or 36 */
|
||||
outb_p(0xaa, 0x3fa); /* Inverse of 55 */
|
||||
outb_p(0x36, 0x3fa); /* Address the chip */
|
||||
outb_p(0xe4, 0x3fa); /* 390/4; 390 = config address */
|
||||
outb_p(0x1b, 0x2fa); /* Inverse of e4 */
|
||||
outb_p(0x0f, 0x390); /* Write index */
|
||||
if (inb_p(0x391) != 0xe4) /* Config address found? */
|
||||
return -ENODEV; /* No: no 82C710 here */
|
||||
|
||||
outb_p(0x0d, 0x390); /* Write index */
|
||||
ct82c710_iores.start = inb_p(0x391) << 2; /* Get mouse I/O address */
|
||||
ct82c710_iores.end = ct82c710_iores.start + 1;
|
||||
ct82c710_iores.flags = IORESOURCE_IO;
|
||||
outb_p(0x0f, 0x390);
|
||||
outb_p(0x0f, 0x391); /* Close config mode */
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int ct82c710_probe(struct platform_device *dev)
|
||||
{
|
||||
ct82c710_port = kzalloc(sizeof(struct serio), GFP_KERNEL);
|
||||
if (!ct82c710_port)
|
||||
return -ENOMEM;
|
||||
|
||||
ct82c710_port->id.type = SERIO_8042;
|
||||
ct82c710_port->dev.parent = &dev->dev;
|
||||
ct82c710_port->open = ct82c710_open;
|
||||
ct82c710_port->close = ct82c710_close;
|
||||
ct82c710_port->write = ct82c710_write;
|
||||
strlcpy(ct82c710_port->name, "C&T 82c710 mouse port",
|
||||
sizeof(ct82c710_port->name));
|
||||
snprintf(ct82c710_port->phys, sizeof(ct82c710_port->phys),
|
||||
"isa%16llx/serio0", (unsigned long long)CT82C710_DATA);
|
||||
|
||||
serio_register_port(ct82c710_port);
|
||||
|
||||
printk(KERN_INFO "serio: C&T 82c710 mouse port at %#llx irq %d\n",
|
||||
(unsigned long long)CT82C710_DATA, CT82C710_IRQ);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int ct82c710_remove(struct platform_device *dev)
|
||||
{
|
||||
serio_unregister_port(ct82c710_port);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static struct platform_driver ct82c710_driver = {
|
||||
.driver = {
|
||||
.name = "ct82c710",
|
||||
.owner = THIS_MODULE,
|
||||
},
|
||||
.probe = ct82c710_probe,
|
||||
.remove = ct82c710_remove,
|
||||
};
|
||||
|
||||
|
||||
static int __init ct82c710_init(void)
|
||||
{
|
||||
int error;
|
||||
|
||||
error = ct82c710_detect();
|
||||
if (error)
|
||||
return error;
|
||||
|
||||
error = platform_driver_register(&ct82c710_driver);
|
||||
if (error)
|
||||
return error;
|
||||
|
||||
ct82c710_device = platform_device_alloc("ct82c710", -1);
|
||||
if (!ct82c710_device) {
|
||||
error = -ENOMEM;
|
||||
goto err_unregister_driver;
|
||||
}
|
||||
|
||||
error = platform_device_add_resources(ct82c710_device, &ct82c710_iores, 1);
|
||||
if (error)
|
||||
goto err_free_device;
|
||||
|
||||
error = platform_device_add(ct82c710_device);
|
||||
if (error)
|
||||
goto err_free_device;
|
||||
|
||||
return 0;
|
||||
|
||||
err_free_device:
|
||||
platform_device_put(ct82c710_device);
|
||||
err_unregister_driver:
|
||||
platform_driver_unregister(&ct82c710_driver);
|
||||
return error;
|
||||
}
|
||||
|
||||
static void __exit ct82c710_exit(void)
|
||||
{
|
||||
platform_device_unregister(ct82c710_device);
|
||||
platform_driver_unregister(&ct82c710_driver);
|
||||
}
|
||||
|
||||
module_init(ct82c710_init);
|
||||
module_exit(ct82c710_exit);
|
||||
Loading…
Add table
Add a link
Reference in a new issue