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
5
arch/sh/boards/mach-sh03/Makefile
Normal file
5
arch/sh/boards/mach-sh03/Makefile
Normal file
|
|
@ -0,0 +1,5 @@
|
|||
#
|
||||
# Makefile for the Interface (CTP/PCI-SH03) specific parts of the kernel
|
||||
#
|
||||
|
||||
obj-y := setup.o rtc.o
|
||||
132
arch/sh/boards/mach-sh03/rtc.c
Normal file
132
arch/sh/boards/mach-sh03/rtc.c
Normal file
|
|
@ -0,0 +1,132 @@
|
|||
/*
|
||||
* linux/arch/sh/boards/sh03/rtc.c -- CTP/PCI-SH03 on-chip RTC support
|
||||
*
|
||||
* Copyright (C) 2004 Saito.K & Jeanne(ksaito@interface.co.jp)
|
||||
*
|
||||
*/
|
||||
|
||||
#include <linux/init.h>
|
||||
#include <linux/kernel.h>
|
||||
#include <linux/sched.h>
|
||||
#include <linux/time.h>
|
||||
#include <linux/bcd.h>
|
||||
#include <linux/rtc.h>
|
||||
#include <linux/spinlock.h>
|
||||
#include <asm/io.h>
|
||||
#include <asm/rtc.h>
|
||||
|
||||
#define RTC_BASE 0xb0000000
|
||||
#define RTC_SEC1 (RTC_BASE + 0)
|
||||
#define RTC_SEC10 (RTC_BASE + 1)
|
||||
#define RTC_MIN1 (RTC_BASE + 2)
|
||||
#define RTC_MIN10 (RTC_BASE + 3)
|
||||
#define RTC_HOU1 (RTC_BASE + 4)
|
||||
#define RTC_HOU10 (RTC_BASE + 5)
|
||||
#define RTC_WEE1 (RTC_BASE + 6)
|
||||
#define RTC_DAY1 (RTC_BASE + 7)
|
||||
#define RTC_DAY10 (RTC_BASE + 8)
|
||||
#define RTC_MON1 (RTC_BASE + 9)
|
||||
#define RTC_MON10 (RTC_BASE + 10)
|
||||
#define RTC_YEA1 (RTC_BASE + 11)
|
||||
#define RTC_YEA10 (RTC_BASE + 12)
|
||||
#define RTC_YEA100 (RTC_BASE + 13)
|
||||
#define RTC_YEA1000 (RTC_BASE + 14)
|
||||
#define RTC_CTL (RTC_BASE + 15)
|
||||
#define RTC_BUSY 1
|
||||
#define RTC_STOP 2
|
||||
|
||||
static DEFINE_SPINLOCK(sh03_rtc_lock);
|
||||
|
||||
unsigned long get_cmos_time(void)
|
||||
{
|
||||
unsigned int year, mon, day, hour, min, sec;
|
||||
|
||||
spin_lock(&sh03_rtc_lock);
|
||||
again:
|
||||
do {
|
||||
sec = (__raw_readb(RTC_SEC1) & 0xf) + (__raw_readb(RTC_SEC10) & 0x7) * 10;
|
||||
min = (__raw_readb(RTC_MIN1) & 0xf) + (__raw_readb(RTC_MIN10) & 0xf) * 10;
|
||||
hour = (__raw_readb(RTC_HOU1) & 0xf) + (__raw_readb(RTC_HOU10) & 0xf) * 10;
|
||||
day = (__raw_readb(RTC_DAY1) & 0xf) + (__raw_readb(RTC_DAY10) & 0xf) * 10;
|
||||
mon = (__raw_readb(RTC_MON1) & 0xf) + (__raw_readb(RTC_MON10) & 0xf) * 10;
|
||||
year = (__raw_readb(RTC_YEA1) & 0xf) + (__raw_readb(RTC_YEA10) & 0xf) * 10
|
||||
+ (__raw_readb(RTC_YEA100 ) & 0xf) * 100
|
||||
+ (__raw_readb(RTC_YEA1000) & 0xf) * 1000;
|
||||
} while (sec != (__raw_readb(RTC_SEC1) & 0xf) + (__raw_readb(RTC_SEC10) & 0x7) * 10);
|
||||
if (year == 0 || mon < 1 || mon > 12 || day > 31 || day < 1 ||
|
||||
hour > 23 || min > 59 || sec > 59) {
|
||||
printk(KERN_ERR
|
||||
"SH-03 RTC: invalid value, resetting to 1 Jan 2000\n");
|
||||
printk("year=%d, mon=%d, day=%d, hour=%d, min=%d, sec=%d\n",
|
||||
year, mon, day, hour, min, sec);
|
||||
|
||||
__raw_writeb(0, RTC_SEC1); __raw_writeb(0, RTC_SEC10);
|
||||
__raw_writeb(0, RTC_MIN1); __raw_writeb(0, RTC_MIN10);
|
||||
__raw_writeb(0, RTC_HOU1); __raw_writeb(0, RTC_HOU10);
|
||||
__raw_writeb(6, RTC_WEE1);
|
||||
__raw_writeb(1, RTC_DAY1); __raw_writeb(0, RTC_DAY10);
|
||||
__raw_writeb(1, RTC_MON1); __raw_writeb(0, RTC_MON10);
|
||||
__raw_writeb(0, RTC_YEA1); __raw_writeb(0, RTC_YEA10);
|
||||
__raw_writeb(0, RTC_YEA100);
|
||||
__raw_writeb(2, RTC_YEA1000);
|
||||
__raw_writeb(0, RTC_CTL);
|
||||
goto again;
|
||||
}
|
||||
|
||||
spin_unlock(&sh03_rtc_lock);
|
||||
return mktime(year, mon, day, hour, min, sec);
|
||||
}
|
||||
|
||||
void sh03_rtc_gettimeofday(struct timespec *tv)
|
||||
{
|
||||
|
||||
tv->tv_sec = get_cmos_time();
|
||||
tv->tv_nsec = 0;
|
||||
}
|
||||
|
||||
static int set_rtc_mmss(unsigned long nowtime)
|
||||
{
|
||||
int retval = 0;
|
||||
int real_seconds, real_minutes, cmos_minutes;
|
||||
int i;
|
||||
|
||||
/* gets recalled with irq locally disabled */
|
||||
spin_lock(&sh03_rtc_lock);
|
||||
for (i = 0 ; i < 1000000 ; i++) /* may take up to 1 second... */
|
||||
if (!(__raw_readb(RTC_CTL) & RTC_BUSY))
|
||||
break;
|
||||
cmos_minutes = (__raw_readb(RTC_MIN1) & 0xf) + (__raw_readb(RTC_MIN10) & 0xf) * 10;
|
||||
real_seconds = nowtime % 60;
|
||||
real_minutes = nowtime / 60;
|
||||
if (((abs(real_minutes - cmos_minutes) + 15)/30) & 1)
|
||||
real_minutes += 30; /* correct for half hour time zone */
|
||||
real_minutes %= 60;
|
||||
|
||||
if (abs(real_minutes - cmos_minutes) < 30) {
|
||||
__raw_writeb(real_seconds % 10, RTC_SEC1);
|
||||
__raw_writeb(real_seconds / 10, RTC_SEC10);
|
||||
__raw_writeb(real_minutes % 10, RTC_MIN1);
|
||||
__raw_writeb(real_minutes / 10, RTC_MIN10);
|
||||
} else {
|
||||
printk_once(KERN_NOTICE
|
||||
"set_rtc_mmss: can't update from %d to %d\n",
|
||||
cmos_minutes, real_minutes);
|
||||
retval = -1;
|
||||
}
|
||||
spin_unlock(&sh03_rtc_lock);
|
||||
|
||||
return retval;
|
||||
}
|
||||
|
||||
int sh03_rtc_settimeofday(const time_t secs)
|
||||
{
|
||||
unsigned long nowtime = secs;
|
||||
|
||||
return set_rtc_mmss(nowtime);
|
||||
}
|
||||
|
||||
void sh03_time_init(void)
|
||||
{
|
||||
rtc_sh_get_time = sh03_rtc_gettimeofday;
|
||||
rtc_sh_set_time = sh03_rtc_settimeofday;
|
||||
}
|
||||
105
arch/sh/boards/mach-sh03/setup.c
Normal file
105
arch/sh/boards/mach-sh03/setup.c
Normal file
|
|
@ -0,0 +1,105 @@
|
|||
/*
|
||||
* linux/arch/sh/boards/sh03/setup.c
|
||||
*
|
||||
* Copyright (C) 2004 Interface Co.,Ltd. Saito.K
|
||||
*
|
||||
*/
|
||||
|
||||
#include <linux/init.h>
|
||||
#include <linux/irq.h>
|
||||
#include <linux/pci.h>
|
||||
#include <linux/platform_device.h>
|
||||
#include <linux/ata_platform.h>
|
||||
#include <asm/io.h>
|
||||
#include <asm/rtc.h>
|
||||
#include <mach-sh03/mach/io.h>
|
||||
#include <mach-sh03/mach/sh03.h>
|
||||
#include <asm/addrspace.h>
|
||||
|
||||
static void __init init_sh03_IRQ(void)
|
||||
{
|
||||
plat_irq_setup_pins(IRQ_MODE_IRQ);
|
||||
}
|
||||
|
||||
/* arch/sh/boards/sh03/rtc.c */
|
||||
void sh03_time_init(void);
|
||||
|
||||
static void __init sh03_setup(char **cmdline_p)
|
||||
{
|
||||
board_time_init = sh03_time_init;
|
||||
}
|
||||
|
||||
static struct resource cf_ide_resources[] = {
|
||||
[0] = {
|
||||
.start = 0x1f0,
|
||||
.end = 0x1f0 + 8,
|
||||
.flags = IORESOURCE_IO,
|
||||
},
|
||||
[1] = {
|
||||
.start = 0x1f0 + 0x206,
|
||||
.end = 0x1f0 +8 + 0x206 + 8,
|
||||
.flags = IORESOURCE_IO,
|
||||
},
|
||||
[2] = {
|
||||
.start = IRL2_IRQ,
|
||||
.flags = IORESOURCE_IRQ,
|
||||
},
|
||||
};
|
||||
|
||||
static struct platform_device cf_ide_device = {
|
||||
.name = "pata_platform",
|
||||
.id = -1,
|
||||
.num_resources = ARRAY_SIZE(cf_ide_resources),
|
||||
.resource = cf_ide_resources,
|
||||
};
|
||||
|
||||
static struct resource heartbeat_resources[] = {
|
||||
[0] = {
|
||||
.start = 0xa0800000,
|
||||
.end = 0xa0800000,
|
||||
.flags = IORESOURCE_MEM,
|
||||
},
|
||||
};
|
||||
|
||||
static struct platform_device heartbeat_device = {
|
||||
.name = "heartbeat",
|
||||
.id = -1,
|
||||
.num_resources = ARRAY_SIZE(heartbeat_resources),
|
||||
.resource = heartbeat_resources,
|
||||
};
|
||||
|
||||
static struct platform_device *sh03_devices[] __initdata = {
|
||||
&heartbeat_device,
|
||||
&cf_ide_device,
|
||||
};
|
||||
|
||||
static int __init sh03_devices_setup(void)
|
||||
{
|
||||
pgprot_t prot;
|
||||
unsigned long paddrbase;
|
||||
void *cf_ide_base;
|
||||
|
||||
/* open I/O area window */
|
||||
paddrbase = virt_to_phys((void *)PA_AREA5_IO);
|
||||
prot = PAGE_KERNEL_PCC(1, _PAGE_PCC_IO16);
|
||||
cf_ide_base = ioremap_prot(paddrbase, PAGE_SIZE, pgprot_val(prot));
|
||||
if (!cf_ide_base) {
|
||||
printk("allocate_cf_area : can't open CF I/O window!\n");
|
||||
return -ENOMEM;
|
||||
}
|
||||
|
||||
/* IDE cmd address : 0x1f0-0x1f7 and 0x3f6 */
|
||||
cf_ide_resources[0].start += (unsigned long)cf_ide_base;
|
||||
cf_ide_resources[0].end += (unsigned long)cf_ide_base;
|
||||
cf_ide_resources[1].start += (unsigned long)cf_ide_base;
|
||||
cf_ide_resources[1].end += (unsigned long)cf_ide_base;
|
||||
|
||||
return platform_add_devices(sh03_devices, ARRAY_SIZE(sh03_devices));
|
||||
}
|
||||
device_initcall(sh03_devices_setup);
|
||||
|
||||
static struct sh_machine_vector mv_sh03 __initmv = {
|
||||
.mv_name = "Interface (CTP/PCI-SH03)",
|
||||
.mv_setup = sh03_setup,
|
||||
.mv_init_irq = init_sh03_IRQ,
|
||||
};
|
||||
Loading…
Add table
Add a link
Reference in a new issue