mirror of
https://github.com/team-infusion-developers/android_kernel_samsung_msm8976.git
synced 2024-11-07 04:09:21 +00:00
[ARM] Orion: remove code duplication in TS209 and TS409 setup files
Signed-off-by: Sylver Bruneau <sylver.bruneau@googlemail.com> Signed-off-by: Lennert Buytenhek <buytenh@marvell.com>
This commit is contained in:
Sylver Bruneau
Lennert Buytenhek
parent
b08d5af396
commit
530c854aa3
5 changed files with 168 additions and 239 deletions
|
|
@ -4,7 +4,7 @@ obj-$(CONFIG_MACH_RD88F5182) += rd88f5182-setup.o
|
|||
obj-$(CONFIG_MACH_KUROBOX_PRO) += kurobox_pro-setup.o
|
||||
obj-$(CONFIG_MACH_LINKSTATION_PRO) += kurobox_pro-setup.o
|
||||
obj-$(CONFIG_MACH_DNS323) += dns323-setup.o
|
||||
obj-$(CONFIG_MACH_TS209) += ts209-setup.o
|
||||
obj-$(CONFIG_MACH_TS409) += ts409-setup.o
|
||||
obj-$(CONFIG_MACH_TS209) += ts209-setup.o tsx09-common.o
|
||||
obj-$(CONFIG_MACH_TS409) += ts409-setup.o tsx09-common.o
|
||||
obj-$(CONFIG_MACH_WRT350N_V2) += wrt350n-v2-setup.o
|
||||
obj-$(CONFIG_MACH_MV2120) += mv2120-setup.o
|
||||
|
|
|
|||
|
|
@ -29,6 +29,7 @@
|
|||
#include <asm/arch/orion5x.h>
|
||||
#include "common.h"
|
||||
#include "mpp.h"
|
||||
#include "tsx09-common.h"
|
||||
|
||||
#define QNAP_TS209_NOR_BOOT_BASE 0xf4000000
|
||||
#define QNAP_TS209_NOR_BOOT_SIZE SZ_8M
|
||||
|
|
@ -185,95 +186,6 @@ static int __init qnap_ts209_pci_init(void)
|
|||
|
||||
subsys_initcall(qnap_ts209_pci_init);
|
||||
|
||||
/*****************************************************************************
|
||||
* Ethernet
|
||||
****************************************************************************/
|
||||
|
||||
static struct mv643xx_eth_platform_data qnap_ts209_eth_data = {
|
||||
.phy_addr = 8,
|
||||
};
|
||||
|
||||
static int __init parse_hex_nibble(char n)
|
||||
{
|
||||
if (n >= '0' && n <= '9')
|
||||
return n - '0';
|
||||
|
||||
if (n >= 'A' && n <= 'F')
|
||||
return n - 'A' + 10;
|
||||
|
||||
if (n >= 'a' && n <= 'f')
|
||||
return n - 'a' + 10;
|
||||
|
||||
return -1;
|
||||
}
|
||||
|
||||
static int __init parse_hex_byte(const char *b)
|
||||
{
|
||||
int hi;
|
||||
int lo;
|
||||
|
||||
hi = parse_hex_nibble(b[0]);
|
||||
lo = parse_hex_nibble(b[1]);
|
||||
|
||||
if (hi < 0 || lo < 0)
|
||||
return -1;
|
||||
|
||||
return (hi << 4) | lo;
|
||||
}
|
||||
|
||||
static int __init check_mac_addr(const char *addr_str)
|
||||
{
|
||||
u_int8_t addr[6];
|
||||
int i;
|
||||
|
||||
for (i = 0; i < 6; i++) {
|
||||
int byte;
|
||||
|
||||
/*
|
||||
* Enforce "xx:xx:xx:xx:xx:xx\n" format.
|
||||
*/
|
||||
if (addr_str[(i * 3) + 2] != ((i < 5) ? ':' : '\n'))
|
||||
return -1;
|
||||
|
||||
byte = parse_hex_byte(addr_str + (i * 3));
|
||||
if (byte < 0)
|
||||
return -1;
|
||||
addr[i] = byte;
|
||||
}
|
||||
|
||||
printk(KERN_INFO "ts209: found ethernet mac address ");
|
||||
for (i = 0; i < 6; i++)
|
||||
printk("%.2x%s", addr[i], (i < 5) ? ":" : ".\n");
|
||||
|
||||
memcpy(qnap_ts209_eth_data.mac_addr, addr, 6);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
/*
|
||||
* The 'NAS Config' flash partition has an ext2 filesystem which
|
||||
* contains a file that has the ethernet MAC address in plain text
|
||||
* (format "xx:xx:xx:xx:xx:xx\n".)
|
||||
*/
|
||||
static void __init ts209_find_mac_addr(void)
|
||||
{
|
||||
unsigned long addr;
|
||||
|
||||
for (addr = 0x00700000; addr < 0x00760000; addr += 1024) {
|
||||
char *nor_page;
|
||||
int ret = 0;
|
||||
|
||||
nor_page = ioremap(QNAP_TS209_NOR_BOOT_BASE + addr, 1024);
|
||||
if (nor_page != NULL) {
|
||||
ret = check_mac_addr(nor_page);
|
||||
iounmap(nor_page);
|
||||
}
|
||||
|
||||
if (ret == 0)
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
/*****************************************************************************
|
||||
* RTC S35390A on I2C bus
|
||||
****************************************************************************/
|
||||
|
|
@ -356,31 +268,6 @@ static struct orion5x_mpp_mode ts209_mpp_modes[] __initdata = {
|
|||
{ -1 },
|
||||
};
|
||||
|
||||
/*
|
||||
* QNAP TS-[12]09 specific power off method via UART1-attached PIC
|
||||
*/
|
||||
#define UART1_REG(x) (UART1_VIRT_BASE + ((UART_##x) << 2))
|
||||
|
||||
static void qnap_ts209_power_off(void)
|
||||
{
|
||||
/* 19200 baud divisor */
|
||||
const unsigned divisor = ((ORION5X_TCLK + (8 * 19200)) / (16 * 19200));
|
||||
|
||||
pr_info("%s: triggering power-off...\n", __func__);
|
||||
|
||||
/* hijack uart1 and reset into sane state (19200,8n1) */
|
||||
orion5x_write(UART1_REG(LCR), 0x83);
|
||||
orion5x_write(UART1_REG(DLL), divisor & 0xff);
|
||||
orion5x_write(UART1_REG(DLM), (divisor >> 8) & 0xff);
|
||||
orion5x_write(UART1_REG(LCR), 0x03);
|
||||
orion5x_write(UART1_REG(IER), 0x00);
|
||||
orion5x_write(UART1_REG(FCR), 0x00);
|
||||
orion5x_write(UART1_REG(MCR), 0x00);
|
||||
|
||||
/* send the power-off command 'A' to PIC */
|
||||
orion5x_write(UART1_REG(TX), 'A');
|
||||
}
|
||||
|
||||
static void __init qnap_ts209_init(void)
|
||||
{
|
||||
/*
|
||||
|
|
@ -402,8 +289,10 @@ static void __init qnap_ts209_init(void)
|
|||
*/
|
||||
orion5x_ehci0_init();
|
||||
orion5x_ehci1_init();
|
||||
ts209_find_mac_addr();
|
||||
orion5x_eth_init(&qnap_ts209_eth_data);
|
||||
qnap_tsx09_find_mac_addr(QNAP_TS209_NOR_BOOT_BASE +
|
||||
qnap_ts209_partitions[5].offset,
|
||||
qnap_ts209_partitions[5].size);
|
||||
orion5x_eth_init(&qnap_tsx09_eth_data);
|
||||
orion5x_i2c_init();
|
||||
orion5x_sata_init(&qnap_ts209_sata_data);
|
||||
orion5x_uart0_init();
|
||||
|
|
@ -425,8 +314,8 @@ static void __init qnap_ts209_init(void)
|
|||
pr_warning("qnap_ts209_init: failed to get RTC IRQ\n");
|
||||
i2c_register_board_info(0, &qnap_ts209_i2c_rtc, 1);
|
||||
|
||||
/* register ts209 specific power-off method */
|
||||
pm_power_off = qnap_ts209_power_off;
|
||||
/* register tsx09 specific power-off method */
|
||||
pm_power_off = qnap_tsx09_power_off;
|
||||
}
|
||||
|
||||
MACHINE_START(TS209, "QNAP TS-109/TS-209")
|
||||
|
|
|
|||
|
|
@ -27,6 +27,7 @@
|
|||
#include <asm/arch/orion5x.h>
|
||||
#include "common.h"
|
||||
#include "mpp.h"
|
||||
#include "tsx09-common.h"
|
||||
|
||||
/*****************************************************************************
|
||||
* QNAP TS-409 Info
|
||||
|
|
@ -151,95 +152,6 @@ static int __init qnap_ts409_pci_init(void)
|
|||
|
||||
subsys_initcall(qnap_ts409_pci_init);
|
||||
|
||||
/*****************************************************************************
|
||||
* Ethernet
|
||||
****************************************************************************/
|
||||
|
||||
static struct mv643xx_eth_platform_data qnap_ts409_eth_data = {
|
||||
.phy_addr = 8,
|
||||
};
|
||||
|
||||
static int __init parse_hex_nibble(char n)
|
||||
{
|
||||
if (n >= '0' && n <= '9')
|
||||
return n - '0';
|
||||
|
||||
if (n >= 'A' && n <= 'F')
|
||||
return n - 'A' + 10;
|
||||
|
||||
if (n >= 'a' && n <= 'f')
|
||||
return n - 'a' + 10;
|
||||
|
||||
return -1;
|
||||
}
|
||||
|
||||
static int __init parse_hex_byte(const char *b)
|
||||
{
|
||||
int hi;
|
||||
int lo;
|
||||
|
||||
hi = parse_hex_nibble(b[0]);
|
||||
lo = parse_hex_nibble(b[1]);
|
||||
|
||||
if (hi < 0 || lo < 0)
|
||||
return -1;
|
||||
|
||||
return (hi << 4) | lo;
|
||||
}
|
||||
|
||||
static int __init check_mac_addr(const char *addr_str)
|
||||
{
|
||||
u_int8_t addr[6];
|
||||
int i;
|
||||
|
||||
for (i = 0; i < 6; i++) {
|
||||
int byte;
|
||||
|
||||
/*
|
||||
* Enforce "xx:xx:xx:xx:xx:xx\n" format.
|
||||
*/
|
||||
if (addr_str[(i * 3) + 2] != ((i < 5) ? ':' : '\n'))
|
||||
return -1;
|
||||
|
||||
byte = parse_hex_byte(addr_str + (i * 3));
|
||||
if (byte < 0)
|
||||
return -1;
|
||||
addr[i] = byte;
|
||||
}
|
||||
|
||||
printk(KERN_INFO "ts409: found ethernet mac address ");
|
||||
for (i = 0; i < 6; i++)
|
||||
printk("%.2x%s", addr[i], (i < 5) ? ":" : ".\n");
|
||||
|
||||
memcpy(qnap_ts409_eth_data.mac_addr, addr, 6);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
/*
|
||||
* The 'NAS Config' flash partition has an ext2 filesystem which
|
||||
* contains a file that has the ethernet MAC address in plain text
|
||||
* (format "xx:xx:xx:xx:xx:xx\n").
|
||||
*/
|
||||
static void __init ts409_find_mac_addr(void)
|
||||
{
|
||||
unsigned long addr;
|
||||
|
||||
for (addr = 0x00700000; addr < 0x00760000; addr += 1024) {
|
||||
char *nor_page;
|
||||
int ret = 0;
|
||||
|
||||
nor_page = ioremap(QNAP_TS409_NOR_BOOT_BASE + addr, 1024);
|
||||
if (nor_page != NULL) {
|
||||
ret = check_mac_addr(nor_page);
|
||||
iounmap(nor_page);
|
||||
}
|
||||
|
||||
if (ret == 0)
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
/*****************************************************************************
|
||||
* RTC S35390A on I2C bus
|
||||
****************************************************************************/
|
||||
|
|
@ -307,32 +219,6 @@ static struct orion5x_mpp_mode ts409_mpp_modes[] __initdata = {
|
|||
{ -1 },
|
||||
};
|
||||
|
||||
/*
|
||||
* QNAP TS-409 specific power off method via UART1-attached PIC
|
||||
*/
|
||||
|
||||
#define UART1_REG(x) (UART1_VIRT_BASE + ((UART_##x) << 2))
|
||||
|
||||
static void qnap_ts409_power_off(void)
|
||||
{
|
||||
/* 19200 baud divisor */
|
||||
const unsigned divisor = ((ORION5X_TCLK + (8 * 19200)) / (16 * 19200));
|
||||
|
||||
pr_info("%s: triggering power-off...\n", __func__);
|
||||
|
||||
/* hijack uart1 and reset into sane state (19200,8n1) */
|
||||
writel(0x83, UART1_REG(LCR));
|
||||
writel(divisor & 0xff, UART1_REG(DLL));
|
||||
writel((divisor >> 8) & 0xff, UART1_REG(DLM));
|
||||
writel(0x03, UART1_REG(LCR));
|
||||
writel(0x00, UART1_REG(IER));
|
||||
writel(0x00, UART1_REG(FCR));
|
||||
writel(0x00, UART1_REG(MCR));
|
||||
|
||||
/* send the power-off command 'A' to PIC */
|
||||
writel('A', UART1_REG(TX));
|
||||
}
|
||||
|
||||
static void __init qnap_ts409_init(void)
|
||||
{
|
||||
/*
|
||||
|
|
@ -346,8 +232,10 @@ static void __init qnap_ts409_init(void)
|
|||
* Configure peripherals.
|
||||
*/
|
||||
orion5x_ehci0_init();
|
||||
ts409_find_mac_addr();
|
||||
orion5x_eth_init(&qnap_ts409_eth_data);
|
||||
qnap_tsx09_find_mac_addr(QNAP_TS409_NOR_BOOT_BASE +
|
||||
qnap_ts409_partitions[5].offset,
|
||||
qnap_ts409_partitions[5].size);
|
||||
orion5x_eth_init(&qnap_tsx09_eth_data);
|
||||
orion5x_i2c_init();
|
||||
orion5x_uart0_init();
|
||||
|
||||
|
|
@ -368,8 +256,8 @@ static void __init qnap_ts409_init(void)
|
|||
pr_warning("qnap_ts409_init: failed to get RTC IRQ\n");
|
||||
i2c_register_board_info(0, &qnap_ts409_i2c_rtc, 1);
|
||||
|
||||
/* register ts409 specific power-off method */
|
||||
pm_power_off = qnap_ts409_power_off;
|
||||
/* register tsx09 specific power-off method */
|
||||
pm_power_off = qnap_tsx09_power_off;
|
||||
}
|
||||
|
||||
MACHINE_START(TS409, "QNAP TS-409")
|
||||
|
|
|
|||
132
arch/arm/mach-orion5x/tsx09-common.c
Normal file
132
arch/arm/mach-orion5x/tsx09-common.c
Normal file
|
|
@ -0,0 +1,132 @@
|
|||
/*
|
||||
* QNAP TS-x09 Boards common functions
|
||||
*
|
||||
* Maintainers: Lennert Buytenhek <buytenh@marvell.com>
|
||||
* Byron Bradley <byron.bbradley@gmail.com>
|
||||
*
|
||||
* 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.
|
||||
*/
|
||||
|
||||
#include <linux/kernel.h>
|
||||
#include <linux/pci.h>
|
||||
#include <linux/mv643xx_eth.h>
|
||||
#include <linux/serial_reg.h>
|
||||
#include "tsx09-common.h"
|
||||
|
||||
/*****************************************************************************
|
||||
* QNAP TS-x09 specific power off method via UART1-attached PIC
|
||||
****************************************************************************/
|
||||
|
||||
#define UART1_REG(x) (UART1_VIRT_BASE + ((UART_##x) << 2))
|
||||
|
||||
void qnap_tsx09_power_off(void)
|
||||
{
|
||||
/* 19200 baud divisor */
|
||||
const unsigned divisor = ((ORION5X_TCLK + (8 * 19200)) / (16 * 19200));
|
||||
|
||||
pr_info("%s: triggering power-off...\n", __func__);
|
||||
|
||||
/* hijack uart1 and reset into sane state (19200,8n1) */
|
||||
writel(0x83, UART1_REG(LCR));
|
||||
writel(divisor & 0xff, UART1_REG(DLL));
|
||||
writel((divisor >> 8) & 0xff, UART1_REG(DLM));
|
||||
writel(0x03, UART1_REG(LCR));
|
||||
writel(0x00, UART1_REG(IER));
|
||||
writel(0x00, UART1_REG(FCR));
|
||||
writel(0x00, UART1_REG(MCR));
|
||||
|
||||
/* send the power-off command 'A' to PIC */
|
||||
writel('A', UART1_REG(TX));
|
||||
}
|
||||
|
||||
/*****************************************************************************
|
||||
* Ethernet
|
||||
****************************************************************************/
|
||||
|
||||
struct mv643xx_eth_platform_data qnap_tsx09_eth_data = {
|
||||
.phy_addr = 8,
|
||||
};
|
||||
|
||||
static int __init qnap_tsx09_parse_hex_nibble(char n)
|
||||
{
|
||||
if (n >= '0' && n <= '9')
|
||||
return n - '0';
|
||||
|
||||
if (n >= 'A' && n <= 'F')
|
||||
return n - 'A' + 10;
|
||||
|
||||
if (n >= 'a' && n <= 'f')
|
||||
return n - 'a' + 10;
|
||||
|
||||
return -1;
|
||||
}
|
||||
|
||||
static int __init qnap_tsx09_parse_hex_byte(const char *b)
|
||||
{
|
||||
int hi;
|
||||
int lo;
|
||||
|
||||
hi = qnap_tsx09_parse_hex_nibble(b[0]);
|
||||
lo = qnap_tsx09_parse_hex_nibble(b[1]);
|
||||
|
||||
if (hi < 0 || lo < 0)
|
||||
return -1;
|
||||
|
||||
return (hi << 4) | lo;
|
||||
}
|
||||
|
||||
static int __init qnap_tsx09_check_mac_addr(const char *addr_str)
|
||||
{
|
||||
u_int8_t addr[6];
|
||||
int i;
|
||||
|
||||
for (i = 0; i < 6; i++) {
|
||||
int byte;
|
||||
|
||||
/*
|
||||
* Enforce "xx:xx:xx:xx:xx:xx\n" format.
|
||||
*/
|
||||
if (addr_str[(i * 3) + 2] != ((i < 5) ? ':' : '\n'))
|
||||
return -1;
|
||||
|
||||
byte = qnap_tsx09_parse_hex_byte(addr_str + (i * 3));
|
||||
if (byte < 0)
|
||||
return -1;
|
||||
addr[i] = byte;
|
||||
}
|
||||
|
||||
printk(KERN_INFO "tsx09: found ethernet mac address ");
|
||||
for (i = 0; i < 6; i++)
|
||||
printk("%.2x%s", addr[i], (i < 5) ? ":" : ".\n");
|
||||
|
||||
memcpy(qnap_tsx09_eth_data.mac_addr, addr, 6);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
/*
|
||||
* The 'NAS Config' flash partition has an ext2 filesystem which
|
||||
* contains a file that has the ethernet MAC address in plain text
|
||||
* (format "xx:xx:xx:xx:xx:xx\n").
|
||||
*/
|
||||
void __init qnap_tsx09_find_mac_addr(u32 mem_base, u32 size)
|
||||
{
|
||||
unsigned long addr;
|
||||
|
||||
for (addr = mem_base; addr < (mem_base + size); addr += 1024) {
|
||||
char *nor_page;
|
||||
int ret = 0;
|
||||
|
||||
nor_page = ioremap(addr, 1024);
|
||||
if (nor_page != NULL) {
|
||||
ret = qnap_tsx09_check_mac_addr(nor_page);
|
||||
iounmap(nor_page);
|
||||
}
|
||||
|
||||
if (ret == 0)
|
||||
break;
|
||||
}
|
||||
}
|
||||
20
arch/arm/mach-orion5x/tsx09-common.h
Normal file
20
arch/arm/mach-orion5x/tsx09-common.h
Normal file
|
|
@ -0,0 +1,20 @@
|
|||
#ifndef __ARCH_ORION5X_TSX09_COMMON_H
|
||||
#define __ARCH_ORION5X_TSX09_COMMON_H
|
||||
|
||||
/*
|
||||
* QNAP TS-x09 Boards power-off function
|
||||
*/
|
||||
extern void qnap_tsx09_power_off(void);
|
||||
|
||||
/*
|
||||
* QNAP TS-x09 Boards function to find Ethernet MAC address in flash memory
|
||||
*/
|
||||
extern void __init qnap_tsx09_find_mac_addr(u32 mem_base, u32 size);
|
||||
|
||||
/*
|
||||
* QNAP TS-x09 Boards ethernet declaration
|
||||
*/
|
||||
extern struct mv643xx_eth_platform_data qnap_tsx09_eth_data;
|
||||
|
||||
|
||||
#endif
|
||||
Loading…
Reference in a new issue