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