xref: /OK3568_Linux_fs/kernel/arch/arm/mach-orion5x/tsx09-common.c (revision 4882a59341e53eb6f0b4789bf948001014eff981)
1*4882a593Smuzhiyun // SPDX-License-Identifier: GPL-2.0-or-later
2*4882a593Smuzhiyun /*
3*4882a593Smuzhiyun  * QNAP TS-x09 Boards common functions
4*4882a593Smuzhiyun  *
5*4882a593Smuzhiyun  * Maintainers: Lennert Buytenhek <buytenh@marvell.com>
6*4882a593Smuzhiyun  *		Byron Bradley <byron.bbradley@gmail.com>
7*4882a593Smuzhiyun  */
8*4882a593Smuzhiyun 
9*4882a593Smuzhiyun #include <linux/kernel.h>
10*4882a593Smuzhiyun #include <linux/pci.h>
11*4882a593Smuzhiyun #include <linux/mv643xx_eth.h>
12*4882a593Smuzhiyun #include <linux/timex.h>
13*4882a593Smuzhiyun #include <linux/serial_reg.h>
14*4882a593Smuzhiyun #include "orion5x.h"
15*4882a593Smuzhiyun #include "tsx09-common.h"
16*4882a593Smuzhiyun #include "common.h"
17*4882a593Smuzhiyun 
18*4882a593Smuzhiyun /*****************************************************************************
19*4882a593Smuzhiyun  * QNAP TS-x09 specific power off method via UART1-attached PIC
20*4882a593Smuzhiyun  ****************************************************************************/
21*4882a593Smuzhiyun 
22*4882a593Smuzhiyun #define UART1_REG(x)	(UART1_VIRT_BASE + ((UART_##x) << 2))
23*4882a593Smuzhiyun 
qnap_tsx09_power_off(void)24*4882a593Smuzhiyun void qnap_tsx09_power_off(void)
25*4882a593Smuzhiyun {
26*4882a593Smuzhiyun 	/* 19200 baud divisor */
27*4882a593Smuzhiyun 	const unsigned divisor = ((orion5x_tclk + (8 * 19200)) / (16 * 19200));
28*4882a593Smuzhiyun 
29*4882a593Smuzhiyun 	pr_info("%s: triggering power-off...\n", __func__);
30*4882a593Smuzhiyun 
31*4882a593Smuzhiyun 	/* hijack uart1 and reset into sane state (19200,8n1) */
32*4882a593Smuzhiyun 	writel(0x83, UART1_REG(LCR));
33*4882a593Smuzhiyun 	writel(divisor & 0xff, UART1_REG(DLL));
34*4882a593Smuzhiyun 	writel((divisor >> 8) & 0xff, UART1_REG(DLM));
35*4882a593Smuzhiyun 	writel(0x03, UART1_REG(LCR));
36*4882a593Smuzhiyun 	writel(0x00, UART1_REG(IER));
37*4882a593Smuzhiyun 	writel(0x00, UART1_REG(FCR));
38*4882a593Smuzhiyun 	writel(0x00, UART1_REG(MCR));
39*4882a593Smuzhiyun 
40*4882a593Smuzhiyun 	/* send the power-off command 'A' to PIC */
41*4882a593Smuzhiyun 	writel('A', UART1_REG(TX));
42*4882a593Smuzhiyun }
43*4882a593Smuzhiyun 
44*4882a593Smuzhiyun /*****************************************************************************
45*4882a593Smuzhiyun  * Ethernet
46*4882a593Smuzhiyun  ****************************************************************************/
47*4882a593Smuzhiyun 
48*4882a593Smuzhiyun struct mv643xx_eth_platform_data qnap_tsx09_eth_data = {
49*4882a593Smuzhiyun 	.phy_addr	= MV643XX_ETH_PHY_ADDR(8),
50*4882a593Smuzhiyun };
51*4882a593Smuzhiyun 
qnap_tsx09_parse_hex_nibble(char n)52*4882a593Smuzhiyun static int __init qnap_tsx09_parse_hex_nibble(char n)
53*4882a593Smuzhiyun {
54*4882a593Smuzhiyun 	if (n >= '0' && n <= '9')
55*4882a593Smuzhiyun 		return n - '0';
56*4882a593Smuzhiyun 
57*4882a593Smuzhiyun 	if (n >= 'A' && n <= 'F')
58*4882a593Smuzhiyun 		return n - 'A' + 10;
59*4882a593Smuzhiyun 
60*4882a593Smuzhiyun 	if (n >= 'a' && n <= 'f')
61*4882a593Smuzhiyun 		return n - 'a' + 10;
62*4882a593Smuzhiyun 
63*4882a593Smuzhiyun 	return -1;
64*4882a593Smuzhiyun }
65*4882a593Smuzhiyun 
qnap_tsx09_parse_hex_byte(const char * b)66*4882a593Smuzhiyun static int __init qnap_tsx09_parse_hex_byte(const char *b)
67*4882a593Smuzhiyun {
68*4882a593Smuzhiyun 	int hi;
69*4882a593Smuzhiyun 	int lo;
70*4882a593Smuzhiyun 
71*4882a593Smuzhiyun 	hi = qnap_tsx09_parse_hex_nibble(b[0]);
72*4882a593Smuzhiyun 	lo = qnap_tsx09_parse_hex_nibble(b[1]);
73*4882a593Smuzhiyun 
74*4882a593Smuzhiyun 	if (hi < 0 || lo < 0)
75*4882a593Smuzhiyun 		return -1;
76*4882a593Smuzhiyun 
77*4882a593Smuzhiyun 	return (hi << 4) | lo;
78*4882a593Smuzhiyun }
79*4882a593Smuzhiyun 
qnap_tsx09_check_mac_addr(const char * addr_str)80*4882a593Smuzhiyun static int __init qnap_tsx09_check_mac_addr(const char *addr_str)
81*4882a593Smuzhiyun {
82*4882a593Smuzhiyun 	u_int8_t addr[6];
83*4882a593Smuzhiyun 	int i;
84*4882a593Smuzhiyun 
85*4882a593Smuzhiyun 	for (i = 0; i < 6; i++) {
86*4882a593Smuzhiyun 		int byte;
87*4882a593Smuzhiyun 
88*4882a593Smuzhiyun 		/*
89*4882a593Smuzhiyun 		 * Enforce "xx:xx:xx:xx:xx:xx\n" format.
90*4882a593Smuzhiyun 		 */
91*4882a593Smuzhiyun 		if (addr_str[(i * 3) + 2] != ((i < 5) ? ':' : '\n'))
92*4882a593Smuzhiyun 			return -1;
93*4882a593Smuzhiyun 
94*4882a593Smuzhiyun 		byte = qnap_tsx09_parse_hex_byte(addr_str + (i * 3));
95*4882a593Smuzhiyun 		if (byte < 0)
96*4882a593Smuzhiyun 			return -1;
97*4882a593Smuzhiyun 		addr[i] = byte;
98*4882a593Smuzhiyun 	}
99*4882a593Smuzhiyun 
100*4882a593Smuzhiyun 	printk(KERN_INFO "tsx09: found ethernet mac address %pM\n", addr);
101*4882a593Smuzhiyun 
102*4882a593Smuzhiyun 	memcpy(qnap_tsx09_eth_data.mac_addr, addr, 6);
103*4882a593Smuzhiyun 
104*4882a593Smuzhiyun 	return 0;
105*4882a593Smuzhiyun }
106*4882a593Smuzhiyun 
107*4882a593Smuzhiyun /*
108*4882a593Smuzhiyun  * The 'NAS Config' flash partition has an ext2 filesystem which
109*4882a593Smuzhiyun  * contains a file that has the ethernet MAC address in plain text
110*4882a593Smuzhiyun  * (format "xx:xx:xx:xx:xx:xx\n").
111*4882a593Smuzhiyun  */
qnap_tsx09_find_mac_addr(u32 mem_base,u32 size)112*4882a593Smuzhiyun void __init qnap_tsx09_find_mac_addr(u32 mem_base, u32 size)
113*4882a593Smuzhiyun {
114*4882a593Smuzhiyun 	unsigned long addr;
115*4882a593Smuzhiyun 
116*4882a593Smuzhiyun 	for (addr = mem_base; addr < (mem_base + size); addr += 1024) {
117*4882a593Smuzhiyun 		char *nor_page;
118*4882a593Smuzhiyun 		int ret = 0;
119*4882a593Smuzhiyun 
120*4882a593Smuzhiyun 		nor_page = ioremap(addr, 1024);
121*4882a593Smuzhiyun 		if (nor_page != NULL) {
122*4882a593Smuzhiyun 			ret = qnap_tsx09_check_mac_addr(nor_page);
123*4882a593Smuzhiyun 			iounmap(nor_page);
124*4882a593Smuzhiyun 		}
125*4882a593Smuzhiyun 
126*4882a593Smuzhiyun 		if (ret == 0)
127*4882a593Smuzhiyun 			break;
128*4882a593Smuzhiyun 	}
129*4882a593Smuzhiyun }
130