mirror of
https://github.com/edk2-porting/linux-next.git
synced 2024-12-24 21:24:00 +08:00
2dc20a51dc
Here's a 63-bit implementation of shed_clock() for PXA2xx. The actual period depends on the value of CLOCK_TICK_RATE and whether or not reduced scaling factors were provided for it. Signed-off-by: Nicolas Pitre <nico@cam.org> Signed-off-by: Russell King <rmk+kernel@arm.linux.org.uk>
415 lines
9.0 KiB
C
415 lines
9.0 KiB
C
/*
|
|
* linux/arch/arm/mach-pxa/generic.c
|
|
*
|
|
* Author: Nicolas Pitre
|
|
* Created: Jun 15, 2001
|
|
* Copyright: MontaVista Software Inc.
|
|
*
|
|
* Code common to all PXA machines.
|
|
*
|
|
* 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.
|
|
*
|
|
* Since this file should be linked before any other machine specific file,
|
|
* the __initcall() here will be executed first. This serves as default
|
|
* initialization stuff for PXA machines which can be overridden later if
|
|
* need be.
|
|
*/
|
|
#include <linux/module.h>
|
|
#include <linux/kernel.h>
|
|
#include <linux/init.h>
|
|
#include <linux/delay.h>
|
|
#include <linux/platform_device.h>
|
|
#include <linux/ioport.h>
|
|
#include <linux/pm.h>
|
|
#include <linux/string.h>
|
|
|
|
#include <linux/sched.h>
|
|
#include <asm/cnt32_to_63.h>
|
|
#include <asm/div64.h>
|
|
|
|
#include <asm/hardware.h>
|
|
#include <asm/irq.h>
|
|
#include <asm/system.h>
|
|
#include <asm/pgtable.h>
|
|
#include <asm/mach/map.h>
|
|
|
|
#include <asm/arch/pxa-regs.h>
|
|
#include <asm/arch/udc.h>
|
|
#include <asm/arch/pxafb.h>
|
|
#include <asm/arch/mmc.h>
|
|
#include <asm/arch/irda.h>
|
|
#include <asm/arch/i2c.h>
|
|
|
|
#include "generic.h"
|
|
|
|
/*
|
|
* This is the PXA2xx sched_clock implementation. This has a resolution
|
|
* of at least 308ns and a maximum value that depends on the value of
|
|
* CLOCK_TICK_RATE.
|
|
*
|
|
* The return value is guaranteed to be monotonic in that range as
|
|
* long as there is always less than 582 seconds between successive
|
|
* calls to this function.
|
|
*/
|
|
unsigned long long sched_clock(void)
|
|
{
|
|
unsigned long long v = cnt32_to_63(OSCR);
|
|
/* Note: top bit ov v needs cleared unless multiplier is even. */
|
|
|
|
#if CLOCK_TICK_RATE == 3686400
|
|
/* 1E9 / 3686400 => 78125 / 288, max value = 32025597s (370 days). */
|
|
/* The <<1 is used to get rid of tick.hi top bit */
|
|
v *= 78125<<1;
|
|
do_div(v, 288<<1);
|
|
#elif CLOCK_TICK_RATE == 3250000
|
|
/* 1E9 / 3250000 => 4000 / 13, max value = 709490156s (8211 days) */
|
|
v *= 4000;
|
|
do_div(v, 13);
|
|
#elif CLOCK_TICK_RATE == 3249600
|
|
/* 1E9 / 3249600 => 625000 / 2031, max value = 4541295s (52 days) */
|
|
v *= 625000;
|
|
do_div(v, 2031);
|
|
#else
|
|
#warning "consider fixing sched_clock for your value of CLOCK_TICK_RATE"
|
|
/*
|
|
* 96-bit math to perform tick * NSEC_PER_SEC / CLOCK_TICK_RATE for
|
|
* any value of CLOCK_TICK_RATE. Max value is in the 80 thousand
|
|
* years range which is nice, but with higher computation cost.
|
|
*/
|
|
{
|
|
union {
|
|
unsigned long long val;
|
|
struct { unsigned long lo, hi; };
|
|
} x;
|
|
unsigned long long y;
|
|
|
|
x.val = v;
|
|
x.hi &= 0x7fffffff;
|
|
y = (unsigned long long)x.lo * NSEC_PER_SEC;
|
|
x.lo = y;
|
|
y = (y >> 32) + (unsigned long long)x.hi * NSEC_PER_SEC;
|
|
x.hi = do_div(y, CLOCK_TICK_RATE);
|
|
do_div(x.val, CLOCK_TICK_RATE);
|
|
x.hi += y;
|
|
v = x.val;
|
|
}
|
|
#endif
|
|
|
|
return v;
|
|
}
|
|
|
|
/*
|
|
* Handy function to set GPIO alternate functions
|
|
*/
|
|
|
|
void pxa_gpio_mode(int gpio_mode)
|
|
{
|
|
unsigned long flags;
|
|
int gpio = gpio_mode & GPIO_MD_MASK_NR;
|
|
int fn = (gpio_mode & GPIO_MD_MASK_FN) >> 8;
|
|
int gafr;
|
|
|
|
local_irq_save(flags);
|
|
if (gpio_mode & GPIO_DFLT_LOW)
|
|
GPCR(gpio) = GPIO_bit(gpio);
|
|
else if (gpio_mode & GPIO_DFLT_HIGH)
|
|
GPSR(gpio) = GPIO_bit(gpio);
|
|
if (gpio_mode & GPIO_MD_MASK_DIR)
|
|
GPDR(gpio) |= GPIO_bit(gpio);
|
|
else
|
|
GPDR(gpio) &= ~GPIO_bit(gpio);
|
|
gafr = GAFR(gpio) & ~(0x3 << (((gpio) & 0xf)*2));
|
|
GAFR(gpio) = gafr | (fn << (((gpio) & 0xf)*2));
|
|
local_irq_restore(flags);
|
|
}
|
|
|
|
EXPORT_SYMBOL(pxa_gpio_mode);
|
|
|
|
/*
|
|
* Routine to safely enable or disable a clock in the CKEN
|
|
*/
|
|
void pxa_set_cken(int clock, int enable)
|
|
{
|
|
unsigned long flags;
|
|
local_irq_save(flags);
|
|
|
|
if (enable)
|
|
CKEN |= clock;
|
|
else
|
|
CKEN &= ~clock;
|
|
|
|
local_irq_restore(flags);
|
|
}
|
|
|
|
EXPORT_SYMBOL(pxa_set_cken);
|
|
|
|
/*
|
|
* Intel PXA2xx internal register mapping.
|
|
*
|
|
* Note 1: not all PXA2xx variants implement all those addresses.
|
|
*
|
|
* Note 2: virtual 0xfffe0000-0xffffffff is reserved for the vector table
|
|
* and cache flush area.
|
|
*/
|
|
static struct map_desc standard_io_desc[] __initdata = {
|
|
{ /* Devs */
|
|
.virtual = 0xf2000000,
|
|
.pfn = __phys_to_pfn(0x40000000),
|
|
.length = 0x02000000,
|
|
.type = MT_DEVICE
|
|
}, { /* LCD */
|
|
.virtual = 0xf4000000,
|
|
.pfn = __phys_to_pfn(0x44000000),
|
|
.length = 0x00100000,
|
|
.type = MT_DEVICE
|
|
}, { /* Mem Ctl */
|
|
.virtual = 0xf6000000,
|
|
.pfn = __phys_to_pfn(0x48000000),
|
|
.length = 0x00100000,
|
|
.type = MT_DEVICE
|
|
}, { /* USB host */
|
|
.virtual = 0xf8000000,
|
|
.pfn = __phys_to_pfn(0x4c000000),
|
|
.length = 0x00100000,
|
|
.type = MT_DEVICE
|
|
}, { /* Camera */
|
|
.virtual = 0xfa000000,
|
|
.pfn = __phys_to_pfn(0x50000000),
|
|
.length = 0x00100000,
|
|
.type = MT_DEVICE
|
|
}, { /* IMem ctl */
|
|
.virtual = 0xfe000000,
|
|
.pfn = __phys_to_pfn(0x58000000),
|
|
.length = 0x00100000,
|
|
.type = MT_DEVICE
|
|
}, { /* UNCACHED_PHYS_0 */
|
|
.virtual = 0xff000000,
|
|
.pfn = __phys_to_pfn(0x00000000),
|
|
.length = 0x00100000,
|
|
.type = MT_DEVICE
|
|
}
|
|
};
|
|
|
|
void __init pxa_map_io(void)
|
|
{
|
|
iotable_init(standard_io_desc, ARRAY_SIZE(standard_io_desc));
|
|
get_clk_frequency_khz(1);
|
|
}
|
|
|
|
|
|
static struct resource pxamci_resources[] = {
|
|
[0] = {
|
|
.start = 0x41100000,
|
|
.end = 0x41100fff,
|
|
.flags = IORESOURCE_MEM,
|
|
},
|
|
[1] = {
|
|
.start = IRQ_MMC,
|
|
.end = IRQ_MMC,
|
|
.flags = IORESOURCE_IRQ,
|
|
},
|
|
};
|
|
|
|
static u64 pxamci_dmamask = 0xffffffffUL;
|
|
|
|
static struct platform_device pxamci_device = {
|
|
.name = "pxa2xx-mci",
|
|
.id = -1,
|
|
.dev = {
|
|
.dma_mask = &pxamci_dmamask,
|
|
.coherent_dma_mask = 0xffffffff,
|
|
},
|
|
.num_resources = ARRAY_SIZE(pxamci_resources),
|
|
.resource = pxamci_resources,
|
|
};
|
|
|
|
void __init pxa_set_mci_info(struct pxamci_platform_data *info)
|
|
{
|
|
pxamci_device.dev.platform_data = info;
|
|
}
|
|
|
|
|
|
static struct pxa2xx_udc_mach_info pxa_udc_info;
|
|
|
|
void __init pxa_set_udc_info(struct pxa2xx_udc_mach_info *info)
|
|
{
|
|
memcpy(&pxa_udc_info, info, sizeof *info);
|
|
}
|
|
|
|
static struct resource pxa2xx_udc_resources[] = {
|
|
[0] = {
|
|
.start = 0x40600000,
|
|
.end = 0x4060ffff,
|
|
.flags = IORESOURCE_MEM,
|
|
},
|
|
[1] = {
|
|
.start = IRQ_USB,
|
|
.end = IRQ_USB,
|
|
.flags = IORESOURCE_IRQ,
|
|
},
|
|
};
|
|
|
|
static u64 udc_dma_mask = ~(u32)0;
|
|
|
|
static struct platform_device udc_device = {
|
|
.name = "pxa2xx-udc",
|
|
.id = -1,
|
|
.resource = pxa2xx_udc_resources,
|
|
.num_resources = ARRAY_SIZE(pxa2xx_udc_resources),
|
|
.dev = {
|
|
.platform_data = &pxa_udc_info,
|
|
.dma_mask = &udc_dma_mask,
|
|
}
|
|
};
|
|
|
|
static struct resource pxafb_resources[] = {
|
|
[0] = {
|
|
.start = 0x44000000,
|
|
.end = 0x4400ffff,
|
|
.flags = IORESOURCE_MEM,
|
|
},
|
|
[1] = {
|
|
.start = IRQ_LCD,
|
|
.end = IRQ_LCD,
|
|
.flags = IORESOURCE_IRQ,
|
|
},
|
|
};
|
|
|
|
static u64 fb_dma_mask = ~(u64)0;
|
|
|
|
static struct platform_device pxafb_device = {
|
|
.name = "pxa2xx-fb",
|
|
.id = -1,
|
|
.dev = {
|
|
.dma_mask = &fb_dma_mask,
|
|
.coherent_dma_mask = 0xffffffff,
|
|
},
|
|
.num_resources = ARRAY_SIZE(pxafb_resources),
|
|
.resource = pxafb_resources,
|
|
};
|
|
|
|
void __init set_pxa_fb_info(struct pxafb_mach_info *info)
|
|
{
|
|
pxafb_device.dev.platform_data = info;
|
|
}
|
|
|
|
void __init set_pxa_fb_parent(struct device *parent_dev)
|
|
{
|
|
pxafb_device.dev.parent = parent_dev;
|
|
}
|
|
|
|
static struct platform_device ffuart_device = {
|
|
.name = "pxa2xx-uart",
|
|
.id = 0,
|
|
};
|
|
static struct platform_device btuart_device = {
|
|
.name = "pxa2xx-uart",
|
|
.id = 1,
|
|
};
|
|
static struct platform_device stuart_device = {
|
|
.name = "pxa2xx-uart",
|
|
.id = 2,
|
|
};
|
|
static struct platform_device hwuart_device = {
|
|
.name = "pxa2xx-uart",
|
|
.id = 3,
|
|
};
|
|
|
|
static struct resource i2c_resources[] = {
|
|
{
|
|
.start = 0x40301680,
|
|
.end = 0x403016a3,
|
|
.flags = IORESOURCE_MEM,
|
|
}, {
|
|
.start = IRQ_I2C,
|
|
.end = IRQ_I2C,
|
|
.flags = IORESOURCE_IRQ,
|
|
},
|
|
};
|
|
|
|
static struct platform_device i2c_device = {
|
|
.name = "pxa2xx-i2c",
|
|
.id = 0,
|
|
.resource = i2c_resources,
|
|
.num_resources = ARRAY_SIZE(i2c_resources),
|
|
};
|
|
|
|
void __init pxa_set_i2c_info(struct i2c_pxa_platform_data *info)
|
|
{
|
|
i2c_device.dev.platform_data = info;
|
|
}
|
|
|
|
static struct resource i2s_resources[] = {
|
|
{
|
|
.start = 0x40400000,
|
|
.end = 0x40400083,
|
|
.flags = IORESOURCE_MEM,
|
|
}, {
|
|
.start = IRQ_I2S,
|
|
.end = IRQ_I2S,
|
|
.flags = IORESOURCE_IRQ,
|
|
},
|
|
};
|
|
|
|
static struct platform_device i2s_device = {
|
|
.name = "pxa2xx-i2s",
|
|
.id = -1,
|
|
.resource = i2s_resources,
|
|
.num_resources = ARRAY_SIZE(i2s_resources),
|
|
};
|
|
|
|
static u64 pxaficp_dmamask = ~(u32)0;
|
|
|
|
static struct platform_device pxaficp_device = {
|
|
.name = "pxa2xx-ir",
|
|
.id = -1,
|
|
.dev = {
|
|
.dma_mask = &pxaficp_dmamask,
|
|
.coherent_dma_mask = 0xffffffff,
|
|
},
|
|
};
|
|
|
|
void __init pxa_set_ficp_info(struct pxaficp_platform_data *info)
|
|
{
|
|
pxaficp_device.dev.platform_data = info;
|
|
}
|
|
|
|
static struct platform_device pxartc_device = {
|
|
.name = "sa1100-rtc",
|
|
.id = -1,
|
|
};
|
|
|
|
static struct platform_device *devices[] __initdata = {
|
|
&pxamci_device,
|
|
&udc_device,
|
|
&pxafb_device,
|
|
&ffuart_device,
|
|
&btuart_device,
|
|
&stuart_device,
|
|
&pxaficp_device,
|
|
&i2c_device,
|
|
&i2s_device,
|
|
&pxartc_device,
|
|
};
|
|
|
|
static int __init pxa_init(void)
|
|
{
|
|
int cpuid, ret;
|
|
|
|
ret = platform_add_devices(devices, ARRAY_SIZE(devices));
|
|
if (ret)
|
|
return ret;
|
|
|
|
/* Only add HWUART for PXA255/26x; PXA210/250/27x do not have it. */
|
|
cpuid = read_cpuid(CPUID_ID);
|
|
if (((cpuid >> 4) & 0xfff) == 0x2d0 ||
|
|
((cpuid >> 4) & 0xfff) == 0x290)
|
|
ret = platform_device_register(&hwuart_device);
|
|
|
|
return ret;
|
|
}
|
|
|
|
subsys_initcall(pxa_init);
|