xref: /OK3568_Linux_fs/u-boot/board/socrates/socrates.c (revision 4882a59341e53eb6f0b4789bf948001014eff981)
1*4882a593Smuzhiyun /*
2*4882a593Smuzhiyun  * (C) Copyright 2008
3*4882a593Smuzhiyun  * Sergei Poselenov, Emcraft Systems, sposelenov@emcraft.com.
4*4882a593Smuzhiyun  *
5*4882a593Smuzhiyun  * Copyright 2004 Freescale Semiconductor.
6*4882a593Smuzhiyun  * (C) Copyright 2002,2003, Motorola Inc.
7*4882a593Smuzhiyun  * Xianghua Xiao, (X.Xiao@motorola.com)
8*4882a593Smuzhiyun  *
9*4882a593Smuzhiyun  * (C) Copyright 2002 Scott McNutt <smcnutt@artesyncp.com>
10*4882a593Smuzhiyun  *
11*4882a593Smuzhiyun  * SPDX-License-Identifier:	GPL-2.0+
12*4882a593Smuzhiyun  */
13*4882a593Smuzhiyun 
14*4882a593Smuzhiyun #include <common.h>
15*4882a593Smuzhiyun #include <pci.h>
16*4882a593Smuzhiyun #include <asm/processor.h>
17*4882a593Smuzhiyun #include <asm/immap_85xx.h>
18*4882a593Smuzhiyun #include <ioports.h>
19*4882a593Smuzhiyun #include <flash.h>
20*4882a593Smuzhiyun #include <linux/libfdt.h>
21*4882a593Smuzhiyun #include <fdt_support.h>
22*4882a593Smuzhiyun #include <asm/io.h>
23*4882a593Smuzhiyun #include <i2c.h>
24*4882a593Smuzhiyun #include <mb862xx.h>
25*4882a593Smuzhiyun #include <video_fb.h>
26*4882a593Smuzhiyun #include "upm_table.h"
27*4882a593Smuzhiyun 
28*4882a593Smuzhiyun DECLARE_GLOBAL_DATA_PTR;
29*4882a593Smuzhiyun 
30*4882a593Smuzhiyun extern flash_info_t flash_info[];	/* FLASH chips info */
31*4882a593Smuzhiyun extern GraphicDevice mb862xx;
32*4882a593Smuzhiyun 
33*4882a593Smuzhiyun void local_bus_init (void);
34*4882a593Smuzhiyun ulong flash_get_size (ulong base, int banknum);
35*4882a593Smuzhiyun 
checkboard(void)36*4882a593Smuzhiyun int checkboard (void)
37*4882a593Smuzhiyun {
38*4882a593Smuzhiyun 	volatile ccsr_gur_t *gur = (void *)(CONFIG_SYS_MPC85xx_GUTS_ADDR);
39*4882a593Smuzhiyun 	char buf[64];
40*4882a593Smuzhiyun 	int f;
41*4882a593Smuzhiyun 	int i = env_get_f("serial#", buf, sizeof(buf));
42*4882a593Smuzhiyun #ifdef CONFIG_PCI
43*4882a593Smuzhiyun 	char *src;
44*4882a593Smuzhiyun #endif
45*4882a593Smuzhiyun 
46*4882a593Smuzhiyun 	puts("Board: Socrates");
47*4882a593Smuzhiyun 	if (i > 0) {
48*4882a593Smuzhiyun 		puts(", serial# ");
49*4882a593Smuzhiyun 		puts(buf);
50*4882a593Smuzhiyun 	}
51*4882a593Smuzhiyun 	putc('\n');
52*4882a593Smuzhiyun 
53*4882a593Smuzhiyun #ifdef CONFIG_PCI
54*4882a593Smuzhiyun 	/* Check the PCI_clk sel bit */
55*4882a593Smuzhiyun 	if (in_be32(&gur->porpllsr) & (1<<15)) {
56*4882a593Smuzhiyun 		src = "SYSCLK";
57*4882a593Smuzhiyun 		f = CONFIG_SYS_CLK_FREQ;
58*4882a593Smuzhiyun 	} else {
59*4882a593Smuzhiyun 		src = "PCI_CLK";
60*4882a593Smuzhiyun 		f = CONFIG_PCI_CLK_FREQ;
61*4882a593Smuzhiyun 	}
62*4882a593Smuzhiyun 	printf ("PCI1:  32 bit, %d MHz (%s)\n",	f/1000000, src);
63*4882a593Smuzhiyun #else
64*4882a593Smuzhiyun 	printf ("PCI1:  disabled\n");
65*4882a593Smuzhiyun #endif
66*4882a593Smuzhiyun 
67*4882a593Smuzhiyun 	/*
68*4882a593Smuzhiyun 	 * Initialize local bus.
69*4882a593Smuzhiyun 	 */
70*4882a593Smuzhiyun 	local_bus_init ();
71*4882a593Smuzhiyun 	return 0;
72*4882a593Smuzhiyun }
73*4882a593Smuzhiyun 
misc_init_r(void)74*4882a593Smuzhiyun int misc_init_r (void)
75*4882a593Smuzhiyun {
76*4882a593Smuzhiyun 	/*
77*4882a593Smuzhiyun 	 * Adjust flash start and offset to detected values
78*4882a593Smuzhiyun 	 */
79*4882a593Smuzhiyun 	gd->bd->bi_flashstart = 0 - gd->bd->bi_flashsize;
80*4882a593Smuzhiyun 	gd->bd->bi_flashoffset = 0;
81*4882a593Smuzhiyun 
82*4882a593Smuzhiyun 	/*
83*4882a593Smuzhiyun 	 * Check if boot FLASH isn't max size
84*4882a593Smuzhiyun 	 */
85*4882a593Smuzhiyun 	if (gd->bd->bi_flashsize < (0 - CONFIG_SYS_FLASH0)) {
86*4882a593Smuzhiyun 		set_lbc_or(0, gd->bd->bi_flashstart |
87*4882a593Smuzhiyun 			   (CONFIG_SYS_OR0_PRELIM & 0x00007fff));
88*4882a593Smuzhiyun 		set_lbc_br(0, gd->bd->bi_flashstart |
89*4882a593Smuzhiyun 			   (CONFIG_SYS_BR0_PRELIM & 0x00007fff));
90*4882a593Smuzhiyun 
91*4882a593Smuzhiyun 		/*
92*4882a593Smuzhiyun 		 * Re-check to get correct base address
93*4882a593Smuzhiyun 		 */
94*4882a593Smuzhiyun 		flash_get_size(gd->bd->bi_flashstart, CONFIG_SYS_MAX_FLASH_BANKS - 1);
95*4882a593Smuzhiyun 	}
96*4882a593Smuzhiyun 
97*4882a593Smuzhiyun 	/*
98*4882a593Smuzhiyun 	 * Check if only one FLASH bank is available
99*4882a593Smuzhiyun 	 */
100*4882a593Smuzhiyun 	if (gd->bd->bi_flashsize != CONFIG_SYS_MAX_FLASH_BANKS * (0 - CONFIG_SYS_FLASH0)) {
101*4882a593Smuzhiyun 		set_lbc_or(1, 0);
102*4882a593Smuzhiyun 		set_lbc_br(1, 0);
103*4882a593Smuzhiyun 
104*4882a593Smuzhiyun 		/*
105*4882a593Smuzhiyun 		 * Re-do flash protection upon new addresses
106*4882a593Smuzhiyun 		 */
107*4882a593Smuzhiyun 		flash_protect (FLAG_PROTECT_CLEAR,
108*4882a593Smuzhiyun 			       gd->bd->bi_flashstart, 0xffffffff,
109*4882a593Smuzhiyun 			       &flash_info[CONFIG_SYS_MAX_FLASH_BANKS - 1]);
110*4882a593Smuzhiyun 
111*4882a593Smuzhiyun 		/* Monitor protection ON by default */
112*4882a593Smuzhiyun 		flash_protect (FLAG_PROTECT_SET,
113*4882a593Smuzhiyun 			       CONFIG_SYS_MONITOR_BASE, CONFIG_SYS_MONITOR_BASE + monitor_flash_len - 1,
114*4882a593Smuzhiyun 			       &flash_info[CONFIG_SYS_MAX_FLASH_BANKS - 1]);
115*4882a593Smuzhiyun 
116*4882a593Smuzhiyun 		/* Environment protection ON by default */
117*4882a593Smuzhiyun 		flash_protect (FLAG_PROTECT_SET,
118*4882a593Smuzhiyun 			       CONFIG_ENV_ADDR,
119*4882a593Smuzhiyun 			       CONFIG_ENV_ADDR + CONFIG_ENV_SECT_SIZE - 1,
120*4882a593Smuzhiyun 			       &flash_info[CONFIG_SYS_MAX_FLASH_BANKS - 1]);
121*4882a593Smuzhiyun 
122*4882a593Smuzhiyun 		/* Redundant environment protection ON by default */
123*4882a593Smuzhiyun 		flash_protect (FLAG_PROTECT_SET,
124*4882a593Smuzhiyun 			       CONFIG_ENV_ADDR_REDUND,
125*4882a593Smuzhiyun 			       CONFIG_ENV_ADDR_REDUND + CONFIG_ENV_SECT_SIZE - 1,
126*4882a593Smuzhiyun 			       &flash_info[CONFIG_SYS_MAX_FLASH_BANKS - 1]);
127*4882a593Smuzhiyun 	}
128*4882a593Smuzhiyun 
129*4882a593Smuzhiyun 	return 0;
130*4882a593Smuzhiyun }
131*4882a593Smuzhiyun 
132*4882a593Smuzhiyun /*
133*4882a593Smuzhiyun  * Initialize Local Bus
134*4882a593Smuzhiyun  */
local_bus_init(void)135*4882a593Smuzhiyun void local_bus_init (void)
136*4882a593Smuzhiyun {
137*4882a593Smuzhiyun 	volatile fsl_lbc_t *lbc = LBC_BASE_ADDR;
138*4882a593Smuzhiyun 	volatile ccsr_local_ecm_t *ecm = (void *)(CONFIG_SYS_MPC85xx_ECM_ADDR);
139*4882a593Smuzhiyun 	sys_info_t sysinfo;
140*4882a593Smuzhiyun 	uint clkdiv;
141*4882a593Smuzhiyun 	uint lbc_mhz;
142*4882a593Smuzhiyun 	uint lcrr = CONFIG_SYS_LBC_LCRR;
143*4882a593Smuzhiyun 
144*4882a593Smuzhiyun 	get_sys_info (&sysinfo);
145*4882a593Smuzhiyun 	clkdiv = lbc->lcrr & LCRR_CLKDIV;
146*4882a593Smuzhiyun 	lbc_mhz = sysinfo.freq_systembus / 1000000 / clkdiv;
147*4882a593Smuzhiyun 
148*4882a593Smuzhiyun 	/* Disable PLL bypass for Local Bus Clock >= 66 MHz */
149*4882a593Smuzhiyun 	if (lbc_mhz >= 66)
150*4882a593Smuzhiyun 		lcrr &= ~LCRR_DBYP;	/* DLL Enabled */
151*4882a593Smuzhiyun 	else
152*4882a593Smuzhiyun 		lcrr |= LCRR_DBYP;	/* DLL Bypass */
153*4882a593Smuzhiyun 
154*4882a593Smuzhiyun 	out_be32 (&lbc->lcrr, lcrr);
155*4882a593Smuzhiyun 	asm ("sync;isync;msync");
156*4882a593Smuzhiyun 
157*4882a593Smuzhiyun 	out_be32 (&lbc->ltesr, 0xffffffff);	/* Clear LBC error interrupts */
158*4882a593Smuzhiyun 	out_be32 (&lbc->lteir, 0xffffffff);	/* Enable LBC error interrupts */
159*4882a593Smuzhiyun 	out_be32 (&ecm->eedr, 0xffffffff);	/* Clear ecm errors */
160*4882a593Smuzhiyun 	out_be32 (&ecm->eeer, 0xffffffff);	/* Enable ecm errors */
161*4882a593Smuzhiyun 
162*4882a593Smuzhiyun 	/* Init UPMA for FPGA access */
163*4882a593Smuzhiyun 	out_be32 (&lbc->mamr, 0x44440); /* Use a customer-supplied value */
164*4882a593Smuzhiyun 	upmconfig (UPMA, (uint *)UPMTableA, sizeof(UPMTableA)/sizeof(int));
165*4882a593Smuzhiyun 
166*4882a593Smuzhiyun 	/* Init UPMB for Lime controller access */
167*4882a593Smuzhiyun 	out_be32 (&lbc->mbmr, 0x444440); /* Use a customer-supplied value */
168*4882a593Smuzhiyun 	upmconfig (UPMB, (uint *)UPMTableB, sizeof(UPMTableB)/sizeof(int));
169*4882a593Smuzhiyun }
170*4882a593Smuzhiyun 
171*4882a593Smuzhiyun #if defined(CONFIG_PCI)
172*4882a593Smuzhiyun /*
173*4882a593Smuzhiyun  * Initialize PCI Devices, report devices found.
174*4882a593Smuzhiyun  */
175*4882a593Smuzhiyun 
176*4882a593Smuzhiyun #ifndef CONFIG_PCI_PNP
177*4882a593Smuzhiyun static struct pci_config_table pci_mpc85xxads_config_table[] = {
178*4882a593Smuzhiyun 	{PCI_ANY_ID, PCI_ANY_ID, PCI_ANY_ID, PCI_ANY_ID,
179*4882a593Smuzhiyun 	 PCI_IDSEL_NUMBER, PCI_ANY_ID,
180*4882a593Smuzhiyun 	 pci_cfgfunc_config_device, {PCI_ENET0_IOADDR,
181*4882a593Smuzhiyun 				     PCI_ENET0_MEMADDR,
182*4882a593Smuzhiyun 				     PCI_COMMAND_MEMORY |
183*4882a593Smuzhiyun 				     PCI_COMMAND_MASTER}},
184*4882a593Smuzhiyun 	{}
185*4882a593Smuzhiyun };
186*4882a593Smuzhiyun #endif
187*4882a593Smuzhiyun 
188*4882a593Smuzhiyun 
189*4882a593Smuzhiyun static struct pci_controller hose = {
190*4882a593Smuzhiyun #ifndef CONFIG_PCI_PNP
191*4882a593Smuzhiyun 	config_table:pci_mpc85xxads_config_table,
192*4882a593Smuzhiyun #endif
193*4882a593Smuzhiyun };
194*4882a593Smuzhiyun 
195*4882a593Smuzhiyun #endif /* CONFIG_PCI */
196*4882a593Smuzhiyun 
197*4882a593Smuzhiyun 
pci_init_board(void)198*4882a593Smuzhiyun void pci_init_board (void)
199*4882a593Smuzhiyun {
200*4882a593Smuzhiyun #ifdef CONFIG_PCI
201*4882a593Smuzhiyun 	pci_mpc85xx_init (&hose);
202*4882a593Smuzhiyun #endif /* CONFIG_PCI */
203*4882a593Smuzhiyun }
204*4882a593Smuzhiyun 
205*4882a593Smuzhiyun #ifdef CONFIG_BOARD_EARLY_INIT_R
board_early_init_r(void)206*4882a593Smuzhiyun int board_early_init_r (void)
207*4882a593Smuzhiyun {
208*4882a593Smuzhiyun 	volatile ccsr_gur_t *gur = (void *)(CONFIG_SYS_MPC85xx_GUTS_ADDR);
209*4882a593Smuzhiyun 
210*4882a593Smuzhiyun 	/* set and reset the GPIO pin 2 which will reset the W83782G chip */
211*4882a593Smuzhiyun 	out_8((unsigned char*)&gur->gpoutdr, 0x3F );
212*4882a593Smuzhiyun 	out_be32((unsigned int*)&gur->gpiocr, 0x200 );	/* enable GPOut */
213*4882a593Smuzhiyun 	udelay(200);
214*4882a593Smuzhiyun 	out_8( (unsigned char*)&gur->gpoutdr, 0x1F );
215*4882a593Smuzhiyun 
216*4882a593Smuzhiyun 	return (0);
217*4882a593Smuzhiyun }
218*4882a593Smuzhiyun #endif /* CONFIG_BOARD_EARLY_INIT_R */
219*4882a593Smuzhiyun 
220*4882a593Smuzhiyun #ifdef CONFIG_OF_BOARD_SETUP
ft_board_setup(void * blob,bd_t * bd)221*4882a593Smuzhiyun int ft_board_setup(void *blob, bd_t *bd)
222*4882a593Smuzhiyun {
223*4882a593Smuzhiyun 	u32 val[12];
224*4882a593Smuzhiyun 	int rc, i = 0;
225*4882a593Smuzhiyun 
226*4882a593Smuzhiyun 	ft_cpu_setup(blob, bd);
227*4882a593Smuzhiyun 
228*4882a593Smuzhiyun 	/* Fixup NOR FLASH mapping */
229*4882a593Smuzhiyun 	val[i++] = 0;				/* chip select number */
230*4882a593Smuzhiyun 	val[i++] = 0;				/* always 0 */
231*4882a593Smuzhiyun 	val[i++] = gd->bd->bi_flashstart;
232*4882a593Smuzhiyun 	val[i++] = gd->bd->bi_flashsize;
233*4882a593Smuzhiyun 
234*4882a593Smuzhiyun 	if (mb862xx.frameAdrs == CONFIG_SYS_LIME_BASE) {
235*4882a593Smuzhiyun 		/* Fixup LIME mapping */
236*4882a593Smuzhiyun 		val[i++] = 2;			/* chip select number */
237*4882a593Smuzhiyun 		val[i++] = 0;			/* always 0 */
238*4882a593Smuzhiyun 		val[i++] = CONFIG_SYS_LIME_BASE;
239*4882a593Smuzhiyun 		val[i++] = CONFIG_SYS_LIME_SIZE;
240*4882a593Smuzhiyun 	}
241*4882a593Smuzhiyun 
242*4882a593Smuzhiyun 	/* Fixup FPGA mapping */
243*4882a593Smuzhiyun 	val[i++] = 3;				/* chip select number */
244*4882a593Smuzhiyun 	val[i++] = 0;				/* always 0 */
245*4882a593Smuzhiyun 	val[i++] = CONFIG_SYS_FPGA_BASE;
246*4882a593Smuzhiyun 	val[i++] = CONFIG_SYS_FPGA_SIZE;
247*4882a593Smuzhiyun 
248*4882a593Smuzhiyun 	rc = fdt_find_and_setprop(blob, "/localbus", "ranges",
249*4882a593Smuzhiyun 				  val, i * sizeof(u32), 1);
250*4882a593Smuzhiyun 	if (rc)
251*4882a593Smuzhiyun 		printf("Unable to update localbus ranges, err=%s\n",
252*4882a593Smuzhiyun 		       fdt_strerror(rc));
253*4882a593Smuzhiyun 
254*4882a593Smuzhiyun 	return 0;
255*4882a593Smuzhiyun }
256*4882a593Smuzhiyun #endif /* CONFIG_OF_BOARD_SETUP */
257*4882a593Smuzhiyun 
258*4882a593Smuzhiyun #define DEFAULT_BRIGHTNESS	25
259*4882a593Smuzhiyun #define BACKLIGHT_ENABLE	(1 << 31)
260*4882a593Smuzhiyun 
261*4882a593Smuzhiyun static const gdc_regs init_regs [] =
262*4882a593Smuzhiyun {
263*4882a593Smuzhiyun 	{0x0100, 0x00010f00},
264*4882a593Smuzhiyun 	{0x0020, 0x801901df},
265*4882a593Smuzhiyun 	{0x0024, 0x00000000},
266*4882a593Smuzhiyun 	{0x0028, 0x00000000},
267*4882a593Smuzhiyun 	{0x002c, 0x00000000},
268*4882a593Smuzhiyun 	{0x0110, 0x00000000},
269*4882a593Smuzhiyun 	{0x0114, 0x00000000},
270*4882a593Smuzhiyun 	{0x0118, 0x01df0320},
271*4882a593Smuzhiyun 	{0x0004, 0x041f0000},
272*4882a593Smuzhiyun 	{0x0008, 0x031f031f},
273*4882a593Smuzhiyun 	{0x000c, 0x017f0349},
274*4882a593Smuzhiyun 	{0x0010, 0x020c0000},
275*4882a593Smuzhiyun 	{0x0014, 0x01df01e9},
276*4882a593Smuzhiyun 	{0x0018, 0x00000000},
277*4882a593Smuzhiyun 	{0x001c, 0x01e00320},
278*4882a593Smuzhiyun 	{0x0100, 0x80010f00},
279*4882a593Smuzhiyun 	{0x0, 0x0}
280*4882a593Smuzhiyun };
281*4882a593Smuzhiyun 
board_get_regs(void)282*4882a593Smuzhiyun const gdc_regs *board_get_regs (void)
283*4882a593Smuzhiyun {
284*4882a593Smuzhiyun 	return init_regs;
285*4882a593Smuzhiyun }
286*4882a593Smuzhiyun 
lime_probe(void)287*4882a593Smuzhiyun int lime_probe(void)
288*4882a593Smuzhiyun {
289*4882a593Smuzhiyun 	uint cfg_br2;
290*4882a593Smuzhiyun 	uint cfg_or2;
291*4882a593Smuzhiyun 	int type;
292*4882a593Smuzhiyun 
293*4882a593Smuzhiyun 	cfg_br2 = get_lbc_br(2);
294*4882a593Smuzhiyun 	cfg_or2 = get_lbc_or(2);
295*4882a593Smuzhiyun 
296*4882a593Smuzhiyun 	/* Configure GPCM for CS2 */
297*4882a593Smuzhiyun 	set_lbc_br(2, 0);
298*4882a593Smuzhiyun 	set_lbc_or(2, 0xfc000410);
299*4882a593Smuzhiyun 	set_lbc_br(2, (CONFIG_SYS_LIME_BASE) | 0x00001901);
300*4882a593Smuzhiyun 
301*4882a593Smuzhiyun 	/* Get controller type */
302*4882a593Smuzhiyun 	type = mb862xx_probe(CONFIG_SYS_LIME_BASE);
303*4882a593Smuzhiyun 
304*4882a593Smuzhiyun 	/* Restore previous CS2 configuration */
305*4882a593Smuzhiyun 	set_lbc_br(2, 0);
306*4882a593Smuzhiyun 	set_lbc_or(2, cfg_or2);
307*4882a593Smuzhiyun 	set_lbc_br(2, cfg_br2);
308*4882a593Smuzhiyun 
309*4882a593Smuzhiyun 	return (type == MB862XX_TYPE_LIME) ? 1 : 0;
310*4882a593Smuzhiyun }
311*4882a593Smuzhiyun 
312*4882a593Smuzhiyun /* Returns Lime base address */
board_video_init(void)313*4882a593Smuzhiyun unsigned int board_video_init (void)
314*4882a593Smuzhiyun {
315*4882a593Smuzhiyun 	if (!lime_probe())
316*4882a593Smuzhiyun 		return 0;
317*4882a593Smuzhiyun 
318*4882a593Smuzhiyun 	mb862xx.winSizeX = 800;
319*4882a593Smuzhiyun 	mb862xx.winSizeY = 480;
320*4882a593Smuzhiyun 	mb862xx.gdfIndex = GDF_15BIT_555RGB;
321*4882a593Smuzhiyun 	mb862xx.gdfBytesPP = 2;
322*4882a593Smuzhiyun 
323*4882a593Smuzhiyun 	return CONFIG_SYS_LIME_BASE;
324*4882a593Smuzhiyun }
325*4882a593Smuzhiyun 
326*4882a593Smuzhiyun #define W83782D_REG_CFG		0x40
327*4882a593Smuzhiyun #define W83782D_REG_BANK_SEL	0x4e
328*4882a593Smuzhiyun #define W83782D_REG_ADCCLK	0x4b
329*4882a593Smuzhiyun #define W83782D_REG_BEEP_CTRL	0x4d
330*4882a593Smuzhiyun #define W83782D_REG_BEEP_CTRL2	0x57
331*4882a593Smuzhiyun #define W83782D_REG_PWMOUT1	0x5b
332*4882a593Smuzhiyun #define W83782D_REG_VBAT	0x5d
333*4882a593Smuzhiyun 
w83782d_hwmon_init(void)334*4882a593Smuzhiyun static int w83782d_hwmon_init(void)
335*4882a593Smuzhiyun {
336*4882a593Smuzhiyun 	u8 buf;
337*4882a593Smuzhiyun 
338*4882a593Smuzhiyun 	if (i2c_read(CONFIG_SYS_I2C_W83782G_ADDR, W83782D_REG_CFG, 1, &buf, 1))
339*4882a593Smuzhiyun 		return -1;
340*4882a593Smuzhiyun 
341*4882a593Smuzhiyun 	i2c_reg_write(CONFIG_SYS_I2C_W83782G_ADDR, W83782D_REG_CFG, 0x80);
342*4882a593Smuzhiyun 	i2c_reg_write(CONFIG_SYS_I2C_W83782G_ADDR, W83782D_REG_BANK_SEL, 0);
343*4882a593Smuzhiyun 	i2c_reg_write(CONFIG_SYS_I2C_W83782G_ADDR, W83782D_REG_ADCCLK, 0x40);
344*4882a593Smuzhiyun 
345*4882a593Smuzhiyun 	buf = i2c_reg_read(CONFIG_SYS_I2C_W83782G_ADDR, W83782D_REG_BEEP_CTRL);
346*4882a593Smuzhiyun 	i2c_reg_write(CONFIG_SYS_I2C_W83782G_ADDR, W83782D_REG_BEEP_CTRL,
347*4882a593Smuzhiyun 		      buf | 0x80);
348*4882a593Smuzhiyun 	i2c_reg_write(CONFIG_SYS_I2C_W83782G_ADDR, W83782D_REG_BEEP_CTRL2, 0);
349*4882a593Smuzhiyun 	i2c_reg_write(CONFIG_SYS_I2C_W83782G_ADDR, W83782D_REG_PWMOUT1, 0x47);
350*4882a593Smuzhiyun 	i2c_reg_write(CONFIG_SYS_I2C_W83782G_ADDR, W83782D_REG_VBAT, 0x01);
351*4882a593Smuzhiyun 
352*4882a593Smuzhiyun 	buf = i2c_reg_read(CONFIG_SYS_I2C_W83782G_ADDR, W83782D_REG_CFG);
353*4882a593Smuzhiyun 	i2c_reg_write(CONFIG_SYS_I2C_W83782G_ADDR, W83782D_REG_CFG,
354*4882a593Smuzhiyun 		      (buf & 0xf4) | 0x01);
355*4882a593Smuzhiyun 	return 0;
356*4882a593Smuzhiyun }
357*4882a593Smuzhiyun 
board_backlight_brightness(int br)358*4882a593Smuzhiyun static void board_backlight_brightness(int br)
359*4882a593Smuzhiyun {
360*4882a593Smuzhiyun 	u32 reg;
361*4882a593Smuzhiyun 	u8 buf;
362*4882a593Smuzhiyun 	u8 old_buf;
363*4882a593Smuzhiyun 
364*4882a593Smuzhiyun 	/* Select bank 0 */
365*4882a593Smuzhiyun 	if (i2c_read(CONFIG_SYS_I2C_W83782G_ADDR, 0x4e, 1, &old_buf, 1))
366*4882a593Smuzhiyun 		goto err;
367*4882a593Smuzhiyun 	else
368*4882a593Smuzhiyun 		buf = old_buf & 0xf8;
369*4882a593Smuzhiyun 
370*4882a593Smuzhiyun 	if (i2c_write(CONFIG_SYS_I2C_W83782G_ADDR, 0x4e, 1, &buf, 1))
371*4882a593Smuzhiyun 		goto err;
372*4882a593Smuzhiyun 
373*4882a593Smuzhiyun 	if (br > 0) {
374*4882a593Smuzhiyun 		/* PWMOUT1 duty cycle ctrl */
375*4882a593Smuzhiyun 		buf = 255 / (100 / br);
376*4882a593Smuzhiyun 		if (i2c_write(CONFIG_SYS_I2C_W83782G_ADDR, 0x5b, 1, &buf, 1))
377*4882a593Smuzhiyun 			goto err;
378*4882a593Smuzhiyun 
379*4882a593Smuzhiyun 		/* LEDs on */
380*4882a593Smuzhiyun 		reg = in_be32((void *)(CONFIG_SYS_FPGA_BASE + 0x0c));
381*4882a593Smuzhiyun 		if (!(reg & BACKLIGHT_ENABLE))
382*4882a593Smuzhiyun 			out_be32((void *)(CONFIG_SYS_FPGA_BASE + 0x0c),
383*4882a593Smuzhiyun 				 reg | BACKLIGHT_ENABLE);
384*4882a593Smuzhiyun 	} else {
385*4882a593Smuzhiyun 		buf = 0;
386*4882a593Smuzhiyun 		if (i2c_write(CONFIG_SYS_I2C_W83782G_ADDR, 0x5b, 1, &buf, 1))
387*4882a593Smuzhiyun 			goto err;
388*4882a593Smuzhiyun 
389*4882a593Smuzhiyun 		/* LEDs off */
390*4882a593Smuzhiyun 		reg = in_be32((void *)(CONFIG_SYS_FPGA_BASE + 0x0c));
391*4882a593Smuzhiyun 		reg &= ~BACKLIGHT_ENABLE;
392*4882a593Smuzhiyun 		out_be32((void *)(CONFIG_SYS_FPGA_BASE + 0x0c), reg);
393*4882a593Smuzhiyun 	}
394*4882a593Smuzhiyun 	/* Restore previous bank setting */
395*4882a593Smuzhiyun 	if (i2c_write(CONFIG_SYS_I2C_W83782G_ADDR, 0x4e, 1, &old_buf, 1))
396*4882a593Smuzhiyun 		goto err;
397*4882a593Smuzhiyun 
398*4882a593Smuzhiyun 	return;
399*4882a593Smuzhiyun err:
400*4882a593Smuzhiyun 	printf("W83782G I2C access failed\n");
401*4882a593Smuzhiyun }
402*4882a593Smuzhiyun 
board_backlight_switch(int flag)403*4882a593Smuzhiyun void board_backlight_switch (int flag)
404*4882a593Smuzhiyun {
405*4882a593Smuzhiyun 	char * param;
406*4882a593Smuzhiyun 	int rc;
407*4882a593Smuzhiyun 
408*4882a593Smuzhiyun 	if (w83782d_hwmon_init())
409*4882a593Smuzhiyun 		printf ("hwmon IC init failed\n");
410*4882a593Smuzhiyun 
411*4882a593Smuzhiyun 	if (flag) {
412*4882a593Smuzhiyun 		param = env_get("brightness");
413*4882a593Smuzhiyun 		rc = param ? simple_strtol(param, NULL, 10) : -1;
414*4882a593Smuzhiyun 		if (rc < 0)
415*4882a593Smuzhiyun 			rc = DEFAULT_BRIGHTNESS;
416*4882a593Smuzhiyun 	} else {
417*4882a593Smuzhiyun 		rc = 0;
418*4882a593Smuzhiyun 	}
419*4882a593Smuzhiyun 	board_backlight_brightness(rc);
420*4882a593Smuzhiyun }
421*4882a593Smuzhiyun 
422*4882a593Smuzhiyun #if defined(CONFIG_CONSOLE_EXTRA_INFO)
423*4882a593Smuzhiyun /*
424*4882a593Smuzhiyun  * Return text to be printed besides the logo.
425*4882a593Smuzhiyun  */
video_get_info_str(int line_number,char * info)426*4882a593Smuzhiyun void video_get_info_str (int line_number, char *info)
427*4882a593Smuzhiyun {
428*4882a593Smuzhiyun 	if (line_number == 1) {
429*4882a593Smuzhiyun 		strcpy (info, " Board: Socrates");
430*4882a593Smuzhiyun 	} else {
431*4882a593Smuzhiyun 		info [0] = '\0';
432*4882a593Smuzhiyun 	}
433*4882a593Smuzhiyun }
434*4882a593Smuzhiyun #endif
435