1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17#include <common.h>
18#include <command.h>
19#include <asm/io.h>
20
21#include "cpld.h"
22
23u8 cpld_read(unsigned int reg)
24{
25 void *p = (void *)CONFIG_SYS_CPLD_BASE;
26
27 return in_8(p + reg);
28}
29
30void cpld_write(unsigned int reg, u8 value)
31{
32 void *p = (void *)CONFIG_SYS_CPLD_BASE;
33
34 out_8(p + reg, value);
35}
36
37
38
39
40void cpld_set_altbank(void)
41{
42 u8 val, curbank, altbank, override;
43
44 val = CPLD_READ(vbank);
45 curbank = val & CPLD_BANK_SEL_MASK;
46
47 switch (curbank) {
48 case CPLD_SELECT_BANK0:
49 case CPLD_SELECT_BANK4:
50 altbank = CPLD_SELECT_BANK4;
51 CPLD_WRITE(vbank, altbank);
52 override = CPLD_READ(software_on);
53 CPLD_WRITE(software_on, override | CPLD_BANK_SEL_EN);
54 CPLD_WRITE(sys_reset, CPLD_SYSTEM_RESET);
55 break;
56 default:
57 printf("CPLD Altbank Fail: Invalid value!\n");
58 return;
59 }
60}
61
62
63
64
65void cpld_set_defbank(void)
66{
67 u8 val;
68
69 val = CPLD_DEFAULT_BANK;
70
71 CPLD_WRITE(global_reset, val);
72}
73
74#ifdef DEBUG
75static void cpld_dump_regs(void)
76{
77 printf("chip_id1 = 0x%02x\n", CPLD_READ(chip_id1));
78 printf("chip_id2 = 0x%02x\n", CPLD_READ(chip_id2));
79 printf("sw_maj_ver = 0x%02x\n", CPLD_READ(sw_maj_ver));
80 printf("sw_min_ver = 0x%02x\n", CPLD_READ(sw_min_ver));
81 printf("hw_ver = 0x%02x\n", CPLD_READ(hw_ver));
82 printf("software_on = 0x%02x\n", CPLD_READ(software_on));
83 printf("cfg_rcw_src = 0x%02x\n", CPLD_READ(cfg_rcw_src));
84 printf("res0 = 0x%02x\n", CPLD_READ(res0));
85 printf("vbank = 0x%02x\n", CPLD_READ(vbank));
86 printf("sw1_sysclk = 0x%02x\n", CPLD_READ(sw1_sysclk));
87 printf("sw2_status = 0x%02x\n", CPLD_READ(sw2_status));
88 printf("sw3_status = 0x%02x\n", CPLD_READ(sw3_status));
89 printf("sw4_status = 0x%02x\n", CPLD_READ(sw4_status));
90 printf("sys_reset = 0x%02x\n", CPLD_READ(sys_reset));
91 printf("global_reset = 0x%02x\n", CPLD_READ(global_reset));
92 printf("res1 = 0x%02x\n", CPLD_READ(res1));
93 putc('\n');
94}
95#endif
96
97#ifndef CONFIG_SPL_BUILD
98int do_cpld(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[])
99{
100 int rc = 0;
101
102 if (argc <= 1)
103 return cmd_usage(cmdtp);
104
105 if (strcmp(argv[1], "reset") == 0) {
106 if (strcmp(argv[2], "altbank") == 0)
107 cpld_set_altbank();
108 else
109 cpld_set_defbank();
110#ifdef DEBUG
111 } else if (strcmp(argv[1], "dump") == 0) {
112 cpld_dump_regs();
113#endif
114 } else
115 rc = cmd_usage(cmdtp);
116
117 return rc;
118}
119
120U_BOOT_CMD(
121 cpld, CONFIG_SYS_MAXARGS, 1, do_cpld,
122 "Reset the board or alternate bank",
123 "reset - reset to default bank\n"
124 "cpld reset altbank - reset to alternate bank\n"
125#ifdef DEBUG
126 "cpld dump - display the CPLD registers\n"
127#endif
128 );
129#endif
130