36b471e047
clk_get() returns ERR_PTR() on error, not NULL. Signed-off-by: Vasiliy Kulikov <segoon@openwall.com> Acked-by: Hans-Christian Egtvedt <hans-christian.egtvedt@atmel.com>
352 lines
7.9 KiB
C
352 lines
7.9 KiB
C
/*
|
|
* Favr-32 board-specific setup code.
|
|
*
|
|
* Copyright (C) 2008 Atmel Corporation
|
|
*
|
|
* 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.
|
|
*/
|
|
#include <linux/clk.h>
|
|
#include <linux/etherdevice.h>
|
|
#include <linux/bootmem.h>
|
|
#include <linux/fb.h>
|
|
#include <linux/init.h>
|
|
#include <linux/platform_device.h>
|
|
#include <linux/types.h>
|
|
#include <linux/linkage.h>
|
|
#include <linux/gpio.h>
|
|
#include <linux/leds.h>
|
|
#include <linux/atmel-mci.h>
|
|
#include <linux/atmel-pwm-bl.h>
|
|
#include <linux/spi/spi.h>
|
|
#include <linux/spi/ads7846.h>
|
|
|
|
#include <sound/atmel-abdac.h>
|
|
|
|
#include <video/atmel_lcdc.h>
|
|
|
|
#include <asm/setup.h>
|
|
|
|
#include <mach/at32ap700x.h>
|
|
#include <mach/init.h>
|
|
#include <mach/board.h>
|
|
#include <mach/portmux.h>
|
|
|
|
/* Oscillator frequencies. These are board-specific */
|
|
unsigned long at32_board_osc_rates[3] = {
|
|
[0] = 32768, /* 32.768 kHz on RTC osc */
|
|
[1] = 20000000, /* 20 MHz on osc0 */
|
|
[2] = 12000000, /* 12 MHz on osc1 */
|
|
};
|
|
|
|
/* Initialized by bootloader-specific startup code. */
|
|
struct tag *bootloader_tags __initdata;
|
|
|
|
static struct atmel_abdac_pdata __initdata abdac0_data = {
|
|
};
|
|
|
|
struct eth_addr {
|
|
u8 addr[6];
|
|
};
|
|
static struct eth_addr __initdata hw_addr[1];
|
|
static struct eth_platform_data __initdata eth_data[1] = {
|
|
{
|
|
.phy_mask = ~(1U << 1),
|
|
},
|
|
};
|
|
|
|
static int ads7843_get_pendown_state(void)
|
|
{
|
|
return !gpio_get_value(GPIO_PIN_PB(3));
|
|
}
|
|
|
|
static struct ads7846_platform_data ads7843_data = {
|
|
.model = 7843,
|
|
.get_pendown_state = ads7843_get_pendown_state,
|
|
.pressure_max = 255,
|
|
/*
|
|
* Values below are for debounce filtering, these can be experimented
|
|
* with further.
|
|
*/
|
|
.debounce_max = 20,
|
|
.debounce_rep = 4,
|
|
.debounce_tol = 5,
|
|
|
|
.keep_vref_on = true,
|
|
.settle_delay_usecs = 500,
|
|
.penirq_recheck_delay_usecs = 100,
|
|
};
|
|
|
|
static struct spi_board_info __initdata spi1_board_info[] = {
|
|
{
|
|
/* ADS7843 touch controller */
|
|
.modalias = "ads7846",
|
|
.max_speed_hz = 2000000,
|
|
.chip_select = 0,
|
|
.bus_num = 1,
|
|
.platform_data = &ads7843_data,
|
|
},
|
|
};
|
|
|
|
static struct mci_platform_data __initdata mci0_data = {
|
|
.slot[0] = {
|
|
.bus_width = 4,
|
|
.detect_pin = -ENODEV,
|
|
.wp_pin = -ENODEV,
|
|
},
|
|
};
|
|
|
|
static struct fb_videomode __initdata lb104v03_modes[] = {
|
|
{
|
|
.name = "640x480 @ 50",
|
|
.refresh = 50,
|
|
.xres = 640, .yres = 480,
|
|
.pixclock = KHZ2PICOS(25100),
|
|
|
|
.left_margin = 90, .right_margin = 70,
|
|
.upper_margin = 30, .lower_margin = 15,
|
|
.hsync_len = 12, .vsync_len = 2,
|
|
|
|
.sync = 0,
|
|
.vmode = FB_VMODE_NONINTERLACED,
|
|
},
|
|
};
|
|
|
|
static struct fb_monspecs __initdata favr32_default_monspecs = {
|
|
.manufacturer = "LG",
|
|
.monitor = "LB104V03",
|
|
.modedb = lb104v03_modes,
|
|
.modedb_len = ARRAY_SIZE(lb104v03_modes),
|
|
.hfmin = 27273,
|
|
.hfmax = 31111,
|
|
.vfmin = 45,
|
|
.vfmax = 60,
|
|
.dclkmax = 28000000,
|
|
};
|
|
|
|
struct atmel_lcdfb_info __initdata favr32_lcdc_data = {
|
|
.default_bpp = 16,
|
|
.default_dmacon = ATMEL_LCDC_DMAEN | ATMEL_LCDC_DMA2DEN,
|
|
.default_lcdcon2 = (ATMEL_LCDC_DISTYPE_TFT
|
|
| ATMEL_LCDC_CLKMOD_ALWAYSACTIVE
|
|
| ATMEL_LCDC_MEMOR_BIG),
|
|
.default_monspecs = &favr32_default_monspecs,
|
|
.guard_time = 2,
|
|
};
|
|
|
|
static struct gpio_led favr32_leds[] = {
|
|
{
|
|
.name = "green",
|
|
.gpio = GPIO_PIN_PE(19),
|
|
.default_trigger = "heartbeat",
|
|
.active_low = 1,
|
|
},
|
|
{
|
|
.name = "red",
|
|
.gpio = GPIO_PIN_PE(20),
|
|
.active_low = 1,
|
|
},
|
|
};
|
|
|
|
static struct gpio_led_platform_data favr32_led_data = {
|
|
.num_leds = ARRAY_SIZE(favr32_leds),
|
|
.leds = favr32_leds,
|
|
};
|
|
|
|
static struct platform_device favr32_led_dev = {
|
|
.name = "leds-gpio",
|
|
.id = 0,
|
|
.dev = {
|
|
.platform_data = &favr32_led_data,
|
|
},
|
|
};
|
|
|
|
/*
|
|
* The next two functions should go away as the boot loader is
|
|
* supposed to initialize the macb address registers with a valid
|
|
* ethernet address. But we need to keep it around for a while until
|
|
* we can be reasonably sure the boot loader does this.
|
|
*
|
|
* The phy_id is ignored as the driver will probe for it.
|
|
*/
|
|
static int __init parse_tag_ethernet(struct tag *tag)
|
|
{
|
|
int i;
|
|
|
|
i = tag->u.ethernet.mac_index;
|
|
if (i < ARRAY_SIZE(hw_addr))
|
|
memcpy(hw_addr[i].addr, tag->u.ethernet.hw_address,
|
|
sizeof(hw_addr[i].addr));
|
|
|
|
return 0;
|
|
}
|
|
__tagtable(ATAG_ETHERNET, parse_tag_ethernet);
|
|
|
|
static void __init set_hw_addr(struct platform_device *pdev)
|
|
{
|
|
struct resource *res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
|
|
const u8 *addr;
|
|
void __iomem *regs;
|
|
struct clk *pclk;
|
|
|
|
if (!res)
|
|
return;
|
|
if (pdev->id >= ARRAY_SIZE(hw_addr))
|
|
return;
|
|
|
|
addr = hw_addr[pdev->id].addr;
|
|
if (!is_valid_ether_addr(addr))
|
|
return;
|
|
|
|
/*
|
|
* Since this is board-specific code, we'll cheat and use the
|
|
* physical address directly as we happen to know that it's
|
|
* the same as the virtual address.
|
|
*/
|
|
regs = (void __iomem __force *)res->start;
|
|
pclk = clk_get(&pdev->dev, "pclk");
|
|
if (IS_ERR(pclk))
|
|
return;
|
|
|
|
clk_enable(pclk);
|
|
__raw_writel((addr[3] << 24) | (addr[2] << 16)
|
|
| (addr[1] << 8) | addr[0], regs + 0x98);
|
|
__raw_writel((addr[5] << 8) | addr[4], regs + 0x9c);
|
|
clk_disable(pclk);
|
|
clk_put(pclk);
|
|
}
|
|
|
|
void __init favr32_setup_leds(void)
|
|
{
|
|
unsigned i;
|
|
|
|
for (i = 0; i < ARRAY_SIZE(favr32_leds); i++)
|
|
at32_select_gpio(favr32_leds[i].gpio, AT32_GPIOF_OUTPUT);
|
|
|
|
platform_device_register(&favr32_led_dev);
|
|
}
|
|
|
|
static struct atmel_pwm_bl_platform_data atmel_pwm_bl_pdata = {
|
|
.pwm_channel = 2,
|
|
.pwm_frequency = 200000,
|
|
.pwm_compare_max = 345,
|
|
.pwm_duty_max = 345,
|
|
.pwm_duty_min = 90,
|
|
.pwm_active_low = 1,
|
|
.gpio_on = GPIO_PIN_PA(28),
|
|
.on_active_low = 0,
|
|
};
|
|
|
|
static struct platform_device atmel_pwm_bl_dev = {
|
|
.name = "atmel-pwm-bl",
|
|
.id = 0,
|
|
.dev = {
|
|
.platform_data = &atmel_pwm_bl_pdata,
|
|
},
|
|
};
|
|
|
|
static void __init favr32_setup_atmel_pwm_bl(void)
|
|
{
|
|
platform_device_register(&atmel_pwm_bl_dev);
|
|
at32_select_gpio(atmel_pwm_bl_pdata.gpio_on, 0);
|
|
}
|
|
|
|
void __init setup_board(void)
|
|
{
|
|
at32_map_usart(3, 0, 0); /* USART 3 => /dev/ttyS0 */
|
|
at32_setup_serial_console(0);
|
|
}
|
|
|
|
static int __init set_abdac_rate(struct platform_device *pdev)
|
|
{
|
|
int retval;
|
|
struct clk *osc1;
|
|
struct clk *pll1;
|
|
struct clk *abdac;
|
|
|
|
if (pdev == NULL)
|
|
return -ENXIO;
|
|
|
|
osc1 = clk_get(NULL, "osc1");
|
|
if (IS_ERR(osc1)) {
|
|
retval = PTR_ERR(osc1);
|
|
goto out;
|
|
}
|
|
|
|
pll1 = clk_get(NULL, "pll1");
|
|
if (IS_ERR(pll1)) {
|
|
retval = PTR_ERR(pll1);
|
|
goto out_osc1;
|
|
}
|
|
|
|
abdac = clk_get(&pdev->dev, "sample_clk");
|
|
if (IS_ERR(abdac)) {
|
|
retval = PTR_ERR(abdac);
|
|
goto out_pll1;
|
|
}
|
|
|
|
retval = clk_set_parent(pll1, osc1);
|
|
if (retval != 0)
|
|
goto out_abdac;
|
|
|
|
/*
|
|
* Rate is 32000 to 50000 and ABDAC oversamples 256x. Multiply, in
|
|
* power of 2, to a value above 80 MHz. Power of 2 so it is possible
|
|
* for the generic clock to divide it down again and 80 MHz is the
|
|
* lowest frequency for the PLL.
|
|
*/
|
|
retval = clk_round_rate(pll1,
|
|
CONFIG_BOARD_FAVR32_ABDAC_RATE * 256 * 16);
|
|
if (retval < 0)
|
|
goto out_abdac;
|
|
|
|
retval = clk_set_rate(pll1, retval);
|
|
if (retval != 0)
|
|
goto out_abdac;
|
|
|
|
retval = clk_set_parent(abdac, pll1);
|
|
if (retval != 0)
|
|
goto out_abdac;
|
|
|
|
out_abdac:
|
|
clk_put(abdac);
|
|
out_pll1:
|
|
clk_put(pll1);
|
|
out_osc1:
|
|
clk_put(osc1);
|
|
out:
|
|
return retval;
|
|
}
|
|
|
|
static int __init favr32_init(void)
|
|
{
|
|
/*
|
|
* Favr-32 uses 32-bit SDRAM interface. Reserve the SDRAM-specific
|
|
* pins so that nobody messes with them.
|
|
*/
|
|
at32_reserve_pin(GPIO_PIOE_BASE, ATMEL_EBI_PE_DATA_ALL);
|
|
|
|
at32_select_gpio(GPIO_PIN_PB(3), 0); /* IRQ from ADS7843 */
|
|
|
|
at32_add_device_usart(0);
|
|
|
|
set_hw_addr(at32_add_device_eth(0, ð_data[0]));
|
|
|
|
spi1_board_info[0].irq = gpio_to_irq(GPIO_PIN_PB(3));
|
|
|
|
set_abdac_rate(at32_add_device_abdac(0, &abdac0_data));
|
|
|
|
at32_add_device_pwm(1 << atmel_pwm_bl_pdata.pwm_channel);
|
|
at32_add_device_spi(1, spi1_board_info, ARRAY_SIZE(spi1_board_info));
|
|
at32_add_device_mci(0, &mci0_data);
|
|
at32_add_device_usba(0, NULL);
|
|
at32_add_device_lcdc(0, &favr32_lcdc_data, fbmem_start, fbmem_size, 0);
|
|
|
|
favr32_setup_leds();
|
|
|
|
favr32_setup_atmel_pwm_bl();
|
|
|
|
return 0;
|
|
}
|
|
postcore_initcall(favr32_init);
|