mirror of
https://github.com/AetherDroid/android_kernel_samsung_on5xelte.git
synced 2025-09-08 17:18: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
305
drivers/isdn/hisax/isurf.c
Normal file
305
drivers/isdn/hisax/isurf.c
Normal file
|
|
@ -0,0 +1,305 @@
|
|||
/* $Id: isurf.c,v 1.12.2.4 2004/01/13 21:46:03 keil Exp $
|
||||
*
|
||||
* low level stuff for Siemens I-Surf/I-Talk cards
|
||||
*
|
||||
* Author Karsten Keil
|
||||
* Copyright by Karsten Keil <keil@isdn4linux.de>
|
||||
*
|
||||
* This software may be used and distributed according to the terms
|
||||
* of the GNU General Public License, incorporated herein by reference.
|
||||
*
|
||||
*/
|
||||
|
||||
#include <linux/init.h>
|
||||
#include "hisax.h"
|
||||
#include "isac.h"
|
||||
#include "isar.h"
|
||||
#include "isdnl1.h"
|
||||
#include <linux/isapnp.h>
|
||||
|
||||
static const char *ISurf_revision = "$Revision: 1.12.2.4 $";
|
||||
|
||||
#define byteout(addr, val) outb(val, addr)
|
||||
#define bytein(addr) inb(addr)
|
||||
|
||||
#define ISURF_ISAR_RESET 1
|
||||
#define ISURF_ISAC_RESET 2
|
||||
#define ISURF_ISAR_EA 4
|
||||
#define ISURF_ARCOFI_RESET 8
|
||||
#define ISURF_RESET (ISURF_ISAR_RESET | ISURF_ISAC_RESET | ISURF_ARCOFI_RESET)
|
||||
|
||||
#define ISURF_ISAR_OFFSET 0
|
||||
#define ISURF_ISAC_OFFSET 0x100
|
||||
#define ISURF_IOMEM_SIZE 0x400
|
||||
/* Interface functions */
|
||||
|
||||
static u_char
|
||||
ReadISAC(struct IsdnCardState *cs, u_char offset)
|
||||
{
|
||||
return (readb(cs->hw.isurf.isac + offset));
|
||||
}
|
||||
|
||||
static void
|
||||
WriteISAC(struct IsdnCardState *cs, u_char offset, u_char value)
|
||||
{
|
||||
writeb(value, cs->hw.isurf.isac + offset); mb();
|
||||
}
|
||||
|
||||
static void
|
||||
ReadISACfifo(struct IsdnCardState *cs, u_char *data, int size)
|
||||
{
|
||||
register int i;
|
||||
for (i = 0; i < size; i++)
|
||||
data[i] = readb(cs->hw.isurf.isac);
|
||||
}
|
||||
|
||||
static void
|
||||
WriteISACfifo(struct IsdnCardState *cs, u_char *data, int size)
|
||||
{
|
||||
register int i;
|
||||
for (i = 0; i < size; i++) {
|
||||
writeb(data[i], cs->hw.isurf.isac); mb();
|
||||
}
|
||||
}
|
||||
|
||||
/* ISAR access routines
|
||||
* mode = 0 access with IRQ on
|
||||
* mode = 1 access with IRQ off
|
||||
* mode = 2 access with IRQ off and using last offset
|
||||
*/
|
||||
|
||||
static u_char
|
||||
ReadISAR(struct IsdnCardState *cs, int mode, u_char offset)
|
||||
{
|
||||
return (readb(cs->hw.isurf.isar + offset));
|
||||
}
|
||||
|
||||
static void
|
||||
WriteISAR(struct IsdnCardState *cs, int mode, u_char offset, u_char value)
|
||||
{
|
||||
writeb(value, cs->hw.isurf.isar + offset); mb();
|
||||
}
|
||||
|
||||
static irqreturn_t
|
||||
isurf_interrupt(int intno, void *dev_id)
|
||||
{
|
||||
struct IsdnCardState *cs = dev_id;
|
||||
u_char val;
|
||||
int cnt = 5;
|
||||
u_long flags;
|
||||
|
||||
spin_lock_irqsave(&cs->lock, flags);
|
||||
val = readb(cs->hw.isurf.isar + ISAR_IRQBIT);
|
||||
Start_ISAR:
|
||||
if (val & ISAR_IRQSTA)
|
||||
isar_int_main(cs);
|
||||
val = readb(cs->hw.isurf.isac + ISAC_ISTA);
|
||||
Start_ISAC:
|
||||
if (val)
|
||||
isac_interrupt(cs, val);
|
||||
val = readb(cs->hw.isurf.isar + ISAR_IRQBIT);
|
||||
if ((val & ISAR_IRQSTA) && --cnt) {
|
||||
if (cs->debug & L1_DEB_HSCX)
|
||||
debugl1(cs, "ISAR IntStat after IntRoutine");
|
||||
goto Start_ISAR;
|
||||
}
|
||||
val = readb(cs->hw.isurf.isac + ISAC_ISTA);
|
||||
if (val && --cnt) {
|
||||
if (cs->debug & L1_DEB_ISAC)
|
||||
debugl1(cs, "ISAC IntStat after IntRoutine");
|
||||
goto Start_ISAC;
|
||||
}
|
||||
if (!cnt)
|
||||
printk(KERN_WARNING "ISurf IRQ LOOP\n");
|
||||
|
||||
writeb(0, cs->hw.isurf.isar + ISAR_IRQBIT); mb();
|
||||
writeb(0xFF, cs->hw.isurf.isac + ISAC_MASK); mb();
|
||||
writeb(0, cs->hw.isurf.isac + ISAC_MASK); mb();
|
||||
writeb(ISAR_IRQMSK, cs->hw.isurf.isar + ISAR_IRQBIT); mb();
|
||||
spin_unlock_irqrestore(&cs->lock, flags);
|
||||
return IRQ_HANDLED;
|
||||
}
|
||||
|
||||
static void
|
||||
release_io_isurf(struct IsdnCardState *cs)
|
||||
{
|
||||
release_region(cs->hw.isurf.reset, 1);
|
||||
iounmap(cs->hw.isurf.isar);
|
||||
release_mem_region(cs->hw.isurf.phymem, ISURF_IOMEM_SIZE);
|
||||
}
|
||||
|
||||
static void
|
||||
reset_isurf(struct IsdnCardState *cs, u_char chips)
|
||||
{
|
||||
printk(KERN_INFO "ISurf: resetting card\n");
|
||||
|
||||
byteout(cs->hw.isurf.reset, chips); /* Reset On */
|
||||
mdelay(10);
|
||||
byteout(cs->hw.isurf.reset, ISURF_ISAR_EA); /* Reset Off */
|
||||
mdelay(10);
|
||||
}
|
||||
|
||||
static int
|
||||
ISurf_card_msg(struct IsdnCardState *cs, int mt, void *arg)
|
||||
{
|
||||
u_long flags;
|
||||
|
||||
switch (mt) {
|
||||
case CARD_RESET:
|
||||
spin_lock_irqsave(&cs->lock, flags);
|
||||
reset_isurf(cs, ISURF_RESET);
|
||||
spin_unlock_irqrestore(&cs->lock, flags);
|
||||
return (0);
|
||||
case CARD_RELEASE:
|
||||
release_io_isurf(cs);
|
||||
return (0);
|
||||
case CARD_INIT:
|
||||
spin_lock_irqsave(&cs->lock, flags);
|
||||
reset_isurf(cs, ISURF_RESET);
|
||||
clear_pending_isac_ints(cs);
|
||||
writeb(0, cs->hw.isurf.isar + ISAR_IRQBIT); mb();
|
||||
initisac(cs);
|
||||
initisar(cs);
|
||||
/* Reenable ISAC IRQ */
|
||||
cs->writeisac(cs, ISAC_MASK, 0);
|
||||
/* RESET Receiver and Transmitter */
|
||||
cs->writeisac(cs, ISAC_CMDR, 0x41);
|
||||
spin_unlock_irqrestore(&cs->lock, flags);
|
||||
return (0);
|
||||
case CARD_TEST:
|
||||
return (0);
|
||||
}
|
||||
return (0);
|
||||
}
|
||||
|
||||
static int
|
||||
isurf_auxcmd(struct IsdnCardState *cs, isdn_ctrl *ic) {
|
||||
int ret;
|
||||
u_long flags;
|
||||
|
||||
if ((ic->command == ISDN_CMD_IOCTL) && (ic->arg == 9)) {
|
||||
ret = isar_auxcmd(cs, ic);
|
||||
spin_lock_irqsave(&cs->lock, flags);
|
||||
if (!ret) {
|
||||
reset_isurf(cs, ISURF_ISAR_EA | ISURF_ISAC_RESET |
|
||||
ISURF_ARCOFI_RESET);
|
||||
initisac(cs);
|
||||
cs->writeisac(cs, ISAC_MASK, 0);
|
||||
cs->writeisac(cs, ISAC_CMDR, 0x41);
|
||||
}
|
||||
spin_unlock_irqrestore(&cs->lock, flags);
|
||||
return (ret);
|
||||
}
|
||||
return (isar_auxcmd(cs, ic));
|
||||
}
|
||||
|
||||
#ifdef __ISAPNP__
|
||||
static struct pnp_card *pnp_c = NULL;
|
||||
#endif
|
||||
|
||||
int setup_isurf(struct IsdnCard *card)
|
||||
{
|
||||
int ver;
|
||||
struct IsdnCardState *cs = card->cs;
|
||||
char tmp[64];
|
||||
|
||||
strcpy(tmp, ISurf_revision);
|
||||
printk(KERN_INFO "HiSax: ISurf driver Rev. %s\n", HiSax_getrev(tmp));
|
||||
|
||||
if (cs->typ != ISDN_CTYPE_ISURF)
|
||||
return (0);
|
||||
if (card->para[1] && card->para[2]) {
|
||||
cs->hw.isurf.reset = card->para[1];
|
||||
cs->hw.isurf.phymem = card->para[2];
|
||||
cs->irq = card->para[0];
|
||||
} else {
|
||||
#ifdef __ISAPNP__
|
||||
if (isapnp_present()) {
|
||||
struct pnp_dev *pnp_d = NULL;
|
||||
int err;
|
||||
|
||||
cs->subtyp = 0;
|
||||
if ((pnp_c = pnp_find_card(
|
||||
ISAPNP_VENDOR('S', 'I', 'E'),
|
||||
ISAPNP_FUNCTION(0x0010), pnp_c))) {
|
||||
if (!(pnp_d = pnp_find_dev(pnp_c,
|
||||
ISAPNP_VENDOR('S', 'I', 'E'),
|
||||
ISAPNP_FUNCTION(0x0010), pnp_d))) {
|
||||
printk(KERN_ERR "ISurfPnP: PnP error card found, no device\n");
|
||||
return (0);
|
||||
}
|
||||
pnp_disable_dev(pnp_d);
|
||||
err = pnp_activate_dev(pnp_d);
|
||||
if (err < 0) {
|
||||
pr_warn("%s: pnp_activate_dev ret=%d\n",
|
||||
__func__, err);
|
||||
return 0;
|
||||
}
|
||||
cs->hw.isurf.reset = pnp_port_start(pnp_d, 0);
|
||||
cs->hw.isurf.phymem = pnp_mem_start(pnp_d, 1);
|
||||
cs->irq = pnp_irq(pnp_d, 0);
|
||||
if (!cs->irq || !cs->hw.isurf.reset || !cs->hw.isurf.phymem) {
|
||||
printk(KERN_ERR "ISurfPnP:some resources are missing %d/%x/%lx\n",
|
||||
cs->irq, cs->hw.isurf.reset, cs->hw.isurf.phymem);
|
||||
pnp_disable_dev(pnp_d);
|
||||
return (0);
|
||||
}
|
||||
} else {
|
||||
printk(KERN_INFO "ISurfPnP: no ISAPnP card found\n");
|
||||
return (0);
|
||||
}
|
||||
} else {
|
||||
printk(KERN_INFO "ISurfPnP: no ISAPnP bus found\n");
|
||||
return (0);
|
||||
}
|
||||
#else
|
||||
printk(KERN_WARNING "HiSax: Siemens I-Surf port/mem not set\n");
|
||||
return (0);
|
||||
#endif
|
||||
}
|
||||
if (!request_region(cs->hw.isurf.reset, 1, "isurf isdn")) {
|
||||
printk(KERN_WARNING
|
||||
"HiSax: Siemens I-Surf config port %x already in use\n",
|
||||
cs->hw.isurf.reset);
|
||||
return (0);
|
||||
}
|
||||
if (!request_region(cs->hw.isurf.phymem, ISURF_IOMEM_SIZE, "isurf iomem")) {
|
||||
printk(KERN_WARNING "HiSax: Siemens I-Surf memory region "
|
||||
"%lx-%lx already in use\n",
|
||||
cs->hw.isurf.phymem,
|
||||
cs->hw.isurf.phymem + ISURF_IOMEM_SIZE);
|
||||
release_region(cs->hw.isurf.reset, 1);
|
||||
return (0);
|
||||
}
|
||||
cs->hw.isurf.isar = ioremap(cs->hw.isurf.phymem, ISURF_IOMEM_SIZE);
|
||||
cs->hw.isurf.isac = cs->hw.isurf.isar + ISURF_ISAC_OFFSET;
|
||||
printk(KERN_INFO
|
||||
"ISurf: defined at 0x%x 0x%lx IRQ %d\n",
|
||||
cs->hw.isurf.reset,
|
||||
cs->hw.isurf.phymem,
|
||||
cs->irq);
|
||||
|
||||
setup_isac(cs);
|
||||
cs->cardmsg = &ISurf_card_msg;
|
||||
cs->irq_func = &isurf_interrupt;
|
||||
cs->auxcmd = &isurf_auxcmd;
|
||||
cs->readisac = &ReadISAC;
|
||||
cs->writeisac = &WriteISAC;
|
||||
cs->readisacfifo = &ReadISACfifo;
|
||||
cs->writeisacfifo = &WriteISACfifo;
|
||||
cs->bcs[0].hw.isar.reg = &cs->hw.isurf.isar_r;
|
||||
cs->bcs[1].hw.isar.reg = &cs->hw.isurf.isar_r;
|
||||
test_and_set_bit(HW_ISAR, &cs->HW_Flags);
|
||||
ISACVersion(cs, "ISurf:");
|
||||
cs->BC_Read_Reg = &ReadISAR;
|
||||
cs->BC_Write_Reg = &WriteISAR;
|
||||
cs->BC_Send_Data = &isar_fill_fifo;
|
||||
ver = ISARVersion(cs, "ISurf:");
|
||||
if (ver < 0) {
|
||||
printk(KERN_WARNING
|
||||
"ISurf: wrong ISAR version (ret = %d)\n", ver);
|
||||
release_io_isurf(cs);
|
||||
return (0);
|
||||
}
|
||||
return (1);
|
||||
}
|
||||
Loading…
Add table
Add a link
Reference in a new issue