1*37c4a5f6SMario Six // SPDX-License-Identifier: GPL-2.0+
2*37c4a5f6SMario Six /*
3*37c4a5f6SMario Six * (C) Copyright 2016
4*37c4a5f6SMario Six * Dirk Eibach, Guntermann & Drunck GmbH, dirk.eibach@gdsys.cc
5*37c4a5f6SMario Six *
6*37c4a5f6SMario Six * (C) Copyright 2017, 2018
7*37c4a5f6SMario Six * Mario Six, Guntermann & Drunck GmbH, mario.six@gdsys.cc
8*37c4a5f6SMario Six *
9*37c4a5f6SMario Six * SPDX-License-Identifier: GPL-2.0+
10*37c4a5f6SMario Six */
11*37c4a5f6SMario Six
12*37c4a5f6SMario Six #include <common.h>
13*37c4a5f6SMario Six #include <axi.h>
14*37c4a5f6SMario Six #include <command.h>
15*37c4a5f6SMario Six #include <console.h>
16*37c4a5f6SMario Six #include <dm.h>
17*37c4a5f6SMario Six
18*37c4a5f6SMario Six /* Currently selected AXI bus device */
19*37c4a5f6SMario Six static struct udevice *axi_cur_bus;
20*37c4a5f6SMario Six /* Transmission size from last command */
21*37c4a5f6SMario Six static uint dp_last_size;
22*37c4a5f6SMario Six /* Address from last command */
23*37c4a5f6SMario Six static uint dp_last_addr;
24*37c4a5f6SMario Six /* Number of bytes to display from last command; default = 64 */
25*37c4a5f6SMario Six static uint dp_last_length = 0x40;
26*37c4a5f6SMario Six
27*37c4a5f6SMario Six /**
28*37c4a5f6SMario Six * show_bus() - Show devices on a single AXI bus
29*37c4a5f6SMario Six * @bus: The AXI bus device to printt information for
30*37c4a5f6SMario Six */
show_bus(struct udevice * bus)31*37c4a5f6SMario Six static void show_bus(struct udevice *bus)
32*37c4a5f6SMario Six {
33*37c4a5f6SMario Six struct udevice *dev;
34*37c4a5f6SMario Six
35*37c4a5f6SMario Six printf("Bus %d:\t%s", bus->req_seq, bus->name);
36*37c4a5f6SMario Six if (device_active(bus))
37*37c4a5f6SMario Six printf(" (active %d)", bus->seq);
38*37c4a5f6SMario Six printf("\n");
39*37c4a5f6SMario Six for (device_find_first_child(bus, &dev);
40*37c4a5f6SMario Six dev;
41*37c4a5f6SMario Six device_find_next_child(&dev))
42*37c4a5f6SMario Six printf(" %s\n", dev->name);
43*37c4a5f6SMario Six }
44*37c4a5f6SMario Six
45*37c4a5f6SMario Six /**
46*37c4a5f6SMario Six * axi_set_cur_bus() - Set the currently active AXI bus
47*37c4a5f6SMario Six * @busnum: The number of the bus (i.e. its sequence number) that should be
48*37c4a5f6SMario Six * made active
49*37c4a5f6SMario Six *
50*37c4a5f6SMario Six * The operations supplied by this command operate only on the currently active
51*37c4a5f6SMario Six * bus.
52*37c4a5f6SMario Six *
53*37c4a5f6SMario Six * Return: 0 if OK, -ve on error
54*37c4a5f6SMario Six */
axi_set_cur_bus(unsigned int busnum)55*37c4a5f6SMario Six static int axi_set_cur_bus(unsigned int busnum)
56*37c4a5f6SMario Six {
57*37c4a5f6SMario Six struct udevice *bus;
58*37c4a5f6SMario Six struct udevice *dummy;
59*37c4a5f6SMario Six int ret;
60*37c4a5f6SMario Six
61*37c4a5f6SMario Six /* Make sure that all sequence numbers are initialized */
62*37c4a5f6SMario Six for (uclass_first_device(UCLASS_AXI, &dummy);
63*37c4a5f6SMario Six dummy;
64*37c4a5f6SMario Six uclass_next_device(&dummy))
65*37c4a5f6SMario Six ;
66*37c4a5f6SMario Six
67*37c4a5f6SMario Six ret = uclass_get_device_by_seq(UCLASS_AXI, busnum, &bus);
68*37c4a5f6SMario Six if (ret) {
69*37c4a5f6SMario Six debug("%s: No bus %d\n", __func__, busnum);
70*37c4a5f6SMario Six return ret;
71*37c4a5f6SMario Six }
72*37c4a5f6SMario Six axi_cur_bus = bus;
73*37c4a5f6SMario Six
74*37c4a5f6SMario Six return 0;
75*37c4a5f6SMario Six }
76*37c4a5f6SMario Six
77*37c4a5f6SMario Six /**
78*37c4a5f6SMario Six * axi_get_cur_bus() - Retrieve the currently active AXI bus device
79*37c4a5f6SMario Six * @busp: Pointer to a struct udevice that receives the currently active bus
80*37c4a5f6SMario Six * device
81*37c4a5f6SMario Six *
82*37c4a5f6SMario Six * Return: 0 if OK, -ve on error
83*37c4a5f6SMario Six */
axi_get_cur_bus(struct udevice ** busp)84*37c4a5f6SMario Six static int axi_get_cur_bus(struct udevice **busp)
85*37c4a5f6SMario Six {
86*37c4a5f6SMario Six if (!axi_cur_bus) {
87*37c4a5f6SMario Six puts("No AXI bus selected\n");
88*37c4a5f6SMario Six return -ENODEV;
89*37c4a5f6SMario Six }
90*37c4a5f6SMario Six *busp = axi_cur_bus;
91*37c4a5f6SMario Six
92*37c4a5f6SMario Six return 0;
93*37c4a5f6SMario Six }
94*37c4a5f6SMario Six
95*37c4a5f6SMario Six /*
96*37c4a5f6SMario Six * Command handlers
97*37c4a5f6SMario Six */
98*37c4a5f6SMario Six
do_axi_show_bus(cmd_tbl_t * cmdtp,int flag,int argc,char * const argv[])99*37c4a5f6SMario Six static int do_axi_show_bus(cmd_tbl_t *cmdtp, int flag, int argc,
100*37c4a5f6SMario Six char * const argv[])
101*37c4a5f6SMario Six {
102*37c4a5f6SMario Six struct udevice *dummy;
103*37c4a5f6SMario Six
104*37c4a5f6SMario Six /* Make sure that all sequence numbers are initialized */
105*37c4a5f6SMario Six for (uclass_first_device(UCLASS_AXI, &dummy);
106*37c4a5f6SMario Six dummy;
107*37c4a5f6SMario Six uclass_next_device(&dummy))
108*37c4a5f6SMario Six ;
109*37c4a5f6SMario Six
110*37c4a5f6SMario Six if (argc == 1) {
111*37c4a5f6SMario Six /* show all busses */
112*37c4a5f6SMario Six struct udevice *bus;
113*37c4a5f6SMario Six
114*37c4a5f6SMario Six for (uclass_first_device(UCLASS_AXI, &bus);
115*37c4a5f6SMario Six bus;
116*37c4a5f6SMario Six uclass_next_device(&bus))
117*37c4a5f6SMario Six show_bus(bus);
118*37c4a5f6SMario Six } else {
119*37c4a5f6SMario Six int i;
120*37c4a5f6SMario Six
121*37c4a5f6SMario Six /* show specific bus */
122*37c4a5f6SMario Six i = simple_strtoul(argv[1], NULL, 10);
123*37c4a5f6SMario Six
124*37c4a5f6SMario Six struct udevice *bus;
125*37c4a5f6SMario Six int ret;
126*37c4a5f6SMario Six
127*37c4a5f6SMario Six ret = uclass_get_device_by_seq(UCLASS_AXI, i, &bus);
128*37c4a5f6SMario Six if (ret) {
129*37c4a5f6SMario Six printf("Invalid bus %d: err=%d\n", i, ret);
130*37c4a5f6SMario Six return CMD_RET_FAILURE;
131*37c4a5f6SMario Six }
132*37c4a5f6SMario Six show_bus(bus);
133*37c4a5f6SMario Six }
134*37c4a5f6SMario Six
135*37c4a5f6SMario Six return 0;
136*37c4a5f6SMario Six }
137*37c4a5f6SMario Six
do_axi_bus_num(cmd_tbl_t * cmdtp,int flag,int argc,char * const argv[])138*37c4a5f6SMario Six static int do_axi_bus_num(cmd_tbl_t *cmdtp, int flag, int argc,
139*37c4a5f6SMario Six char * const argv[])
140*37c4a5f6SMario Six {
141*37c4a5f6SMario Six int ret = 0;
142*37c4a5f6SMario Six int bus_no;
143*37c4a5f6SMario Six
144*37c4a5f6SMario Six if (argc == 1) {
145*37c4a5f6SMario Six /* querying current setting */
146*37c4a5f6SMario Six struct udevice *bus;
147*37c4a5f6SMario Six
148*37c4a5f6SMario Six if (!axi_get_cur_bus(&bus))
149*37c4a5f6SMario Six bus_no = bus->seq;
150*37c4a5f6SMario Six else
151*37c4a5f6SMario Six bus_no = -1;
152*37c4a5f6SMario Six
153*37c4a5f6SMario Six printf("Current bus is %d\n", bus_no);
154*37c4a5f6SMario Six } else {
155*37c4a5f6SMario Six bus_no = simple_strtoul(argv[1], NULL, 10);
156*37c4a5f6SMario Six printf("Setting bus to %d\n", bus_no);
157*37c4a5f6SMario Six
158*37c4a5f6SMario Six ret = axi_set_cur_bus(bus_no);
159*37c4a5f6SMario Six if (ret)
160*37c4a5f6SMario Six printf("Failure changing bus number (%d)\n", ret);
161*37c4a5f6SMario Six }
162*37c4a5f6SMario Six
163*37c4a5f6SMario Six return ret ? CMD_RET_FAILURE : 0;
164*37c4a5f6SMario Six }
165*37c4a5f6SMario Six
do_axi_md(cmd_tbl_t * cmdtp,int flag,int argc,char * const argv[])166*37c4a5f6SMario Six static int do_axi_md(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[])
167*37c4a5f6SMario Six {
168*37c4a5f6SMario Six /* Print that many bytes per line */
169*37c4a5f6SMario Six const uint DISP_LINE_LEN = 16;
170*37c4a5f6SMario Six u8 linebuf[DISP_LINE_LEN];
171*37c4a5f6SMario Six unsigned int k;
172*37c4a5f6SMario Six ulong addr, length, size;
173*37c4a5f6SMario Six ulong nbytes;
174*37c4a5f6SMario Six enum axi_size_t axisize;
175*37c4a5f6SMario Six int unitsize;
176*37c4a5f6SMario Six
177*37c4a5f6SMario Six /*
178*37c4a5f6SMario Six * We use the last specified parameters, unless new ones are
179*37c4a5f6SMario Six * entered.
180*37c4a5f6SMario Six */
181*37c4a5f6SMario Six size = dp_last_size;
182*37c4a5f6SMario Six addr = dp_last_addr;
183*37c4a5f6SMario Six length = dp_last_length;
184*37c4a5f6SMario Six
185*37c4a5f6SMario Six if (argc < 3)
186*37c4a5f6SMario Six return CMD_RET_USAGE;
187*37c4a5f6SMario Six
188*37c4a5f6SMario Six if (!axi_cur_bus) {
189*37c4a5f6SMario Six puts("No AXI bus selected\n");
190*37c4a5f6SMario Six return CMD_RET_FAILURE;
191*37c4a5f6SMario Six }
192*37c4a5f6SMario Six
193*37c4a5f6SMario Six if ((flag & CMD_FLAG_REPEAT) == 0) {
194*37c4a5f6SMario Six size = simple_strtoul(argv[1], NULL, 10);
195*37c4a5f6SMario Six
196*37c4a5f6SMario Six /*
197*37c4a5f6SMario Six * Address is specified since argc >= 3
198*37c4a5f6SMario Six */
199*37c4a5f6SMario Six addr = simple_strtoul(argv[2], NULL, 16);
200*37c4a5f6SMario Six
201*37c4a5f6SMario Six /*
202*37c4a5f6SMario Six * If there's another parameter, it is the length to display;
203*37c4a5f6SMario Six * length is the number of objects, not number of bytes
204*37c4a5f6SMario Six */
205*37c4a5f6SMario Six if (argc > 3)
206*37c4a5f6SMario Six length = simple_strtoul(argv[3], NULL, 16);
207*37c4a5f6SMario Six }
208*37c4a5f6SMario Six
209*37c4a5f6SMario Six switch (size) {
210*37c4a5f6SMario Six case 8:
211*37c4a5f6SMario Six axisize = AXI_SIZE_8;
212*37c4a5f6SMario Six unitsize = 1;
213*37c4a5f6SMario Six break;
214*37c4a5f6SMario Six case 16:
215*37c4a5f6SMario Six axisize = AXI_SIZE_16;
216*37c4a5f6SMario Six unitsize = 2;
217*37c4a5f6SMario Six break;
218*37c4a5f6SMario Six case 32:
219*37c4a5f6SMario Six axisize = AXI_SIZE_32;
220*37c4a5f6SMario Six unitsize = 4;
221*37c4a5f6SMario Six break;
222*37c4a5f6SMario Six default:
223*37c4a5f6SMario Six printf("Unknown read size '%lu'\n", size);
224*37c4a5f6SMario Six return CMD_RET_USAGE;
225*37c4a5f6SMario Six };
226*37c4a5f6SMario Six
227*37c4a5f6SMario Six nbytes = length * unitsize;
228*37c4a5f6SMario Six do {
229*37c4a5f6SMario Six ulong linebytes = (nbytes > DISP_LINE_LEN) ?
230*37c4a5f6SMario Six DISP_LINE_LEN : nbytes;
231*37c4a5f6SMario Six
232*37c4a5f6SMario Six for (k = 0; k < linebytes / unitsize; ++k) {
233*37c4a5f6SMario Six int ret = axi_read(axi_cur_bus, addr + k * unitsize,
234*37c4a5f6SMario Six linebuf + k * unitsize, axisize);
235*37c4a5f6SMario Six
236*37c4a5f6SMario Six if (!ret) /* Continue if axi_read was successful */
237*37c4a5f6SMario Six continue;
238*37c4a5f6SMario Six
239*37c4a5f6SMario Six if (ret == -ENOSYS)
240*37c4a5f6SMario Six printf("axi_read failed; read size not supported?\n");
241*37c4a5f6SMario Six else
242*37c4a5f6SMario Six printf("axi_read failed: err = %d\n", ret);
243*37c4a5f6SMario Six
244*37c4a5f6SMario Six return CMD_RET_FAILURE;
245*37c4a5f6SMario Six }
246*37c4a5f6SMario Six print_buffer(addr, (void *)linebuf, unitsize,
247*37c4a5f6SMario Six linebytes / unitsize,
248*37c4a5f6SMario Six DISP_LINE_LEN / unitsize);
249*37c4a5f6SMario Six
250*37c4a5f6SMario Six nbytes -= max(linebytes, 1UL);
251*37c4a5f6SMario Six addr += linebytes;
252*37c4a5f6SMario Six
253*37c4a5f6SMario Six if (ctrlc())
254*37c4a5f6SMario Six break;
255*37c4a5f6SMario Six } while (nbytes > 0);
256*37c4a5f6SMario Six
257*37c4a5f6SMario Six dp_last_size = size;
258*37c4a5f6SMario Six dp_last_addr = addr;
259*37c4a5f6SMario Six dp_last_length = length;
260*37c4a5f6SMario Six
261*37c4a5f6SMario Six return 0;
262*37c4a5f6SMario Six }
263*37c4a5f6SMario Six
do_axi_mw(cmd_tbl_t * cmdtp,int flag,int argc,char * const argv[])264*37c4a5f6SMario Six static int do_axi_mw(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[])
265*37c4a5f6SMario Six {
266*37c4a5f6SMario Six u32 writeval;
267*37c4a5f6SMario Six ulong addr, count, size;
268*37c4a5f6SMario Six enum axi_size_t axisize;
269*37c4a5f6SMario Six
270*37c4a5f6SMario Six if (argc <= 3 || argc >= 6)
271*37c4a5f6SMario Six return CMD_RET_USAGE;
272*37c4a5f6SMario Six
273*37c4a5f6SMario Six size = simple_strtoul(argv[1], NULL, 10);
274*37c4a5f6SMario Six
275*37c4a5f6SMario Six switch (size) {
276*37c4a5f6SMario Six case 8:
277*37c4a5f6SMario Six axisize = AXI_SIZE_8;
278*37c4a5f6SMario Six break;
279*37c4a5f6SMario Six case 16:
280*37c4a5f6SMario Six axisize = AXI_SIZE_16;
281*37c4a5f6SMario Six break;
282*37c4a5f6SMario Six case 32:
283*37c4a5f6SMario Six axisize = AXI_SIZE_32;
284*37c4a5f6SMario Six break;
285*37c4a5f6SMario Six default:
286*37c4a5f6SMario Six printf("Unknown write size '%lu'\n", size);
287*37c4a5f6SMario Six return CMD_RET_USAGE;
288*37c4a5f6SMario Six };
289*37c4a5f6SMario Six
290*37c4a5f6SMario Six /* Address is specified since argc > 4 */
291*37c4a5f6SMario Six addr = simple_strtoul(argv[2], NULL, 16);
292*37c4a5f6SMario Six
293*37c4a5f6SMario Six /* Get the value to write */
294*37c4a5f6SMario Six writeval = simple_strtoul(argv[3], NULL, 16);
295*37c4a5f6SMario Six
296*37c4a5f6SMario Six /* Count ? */
297*37c4a5f6SMario Six if (argc == 5)
298*37c4a5f6SMario Six count = simple_strtoul(argv[4], NULL, 16);
299*37c4a5f6SMario Six else
300*37c4a5f6SMario Six count = 1;
301*37c4a5f6SMario Six
302*37c4a5f6SMario Six while (count-- > 0) {
303*37c4a5f6SMario Six int ret = axi_write(axi_cur_bus, addr + count * sizeof(u32),
304*37c4a5f6SMario Six &writeval, axisize);
305*37c4a5f6SMario Six
306*37c4a5f6SMario Six if (ret) {
307*37c4a5f6SMario Six printf("axi_write failed: err = %d\n", ret);
308*37c4a5f6SMario Six return CMD_RET_FAILURE;
309*37c4a5f6SMario Six }
310*37c4a5f6SMario Six }
311*37c4a5f6SMario Six
312*37c4a5f6SMario Six return 0;
313*37c4a5f6SMario Six }
314*37c4a5f6SMario Six
315*37c4a5f6SMario Six static cmd_tbl_t cmd_axi_sub[] = {
316*37c4a5f6SMario Six U_BOOT_CMD_MKENT(bus, 1, 1, do_axi_show_bus, "", ""),
317*37c4a5f6SMario Six U_BOOT_CMD_MKENT(dev, 1, 1, do_axi_bus_num, "", ""),
318*37c4a5f6SMario Six U_BOOT_CMD_MKENT(md, 4, 1, do_axi_md, "", ""),
319*37c4a5f6SMario Six U_BOOT_CMD_MKENT(mw, 5, 1, do_axi_mw, "", ""),
320*37c4a5f6SMario Six };
321*37c4a5f6SMario Six
do_ihs_axi(cmd_tbl_t * cmdtp,int flag,int argc,char * const argv[])322*37c4a5f6SMario Six static int do_ihs_axi(cmd_tbl_t *cmdtp, int flag, int argc,
323*37c4a5f6SMario Six char * const argv[])
324*37c4a5f6SMario Six {
325*37c4a5f6SMario Six cmd_tbl_t *c;
326*37c4a5f6SMario Six
327*37c4a5f6SMario Six if (argc < 2)
328*37c4a5f6SMario Six return CMD_RET_USAGE;
329*37c4a5f6SMario Six
330*37c4a5f6SMario Six /* Strip off leading 'axi' command argument */
331*37c4a5f6SMario Six argc--;
332*37c4a5f6SMario Six argv++;
333*37c4a5f6SMario Six
334*37c4a5f6SMario Six /* Hand off rest of command line to sub-commands */
335*37c4a5f6SMario Six c = find_cmd_tbl(argv[0], &cmd_axi_sub[0], ARRAY_SIZE(cmd_axi_sub));
336*37c4a5f6SMario Six
337*37c4a5f6SMario Six if (c)
338*37c4a5f6SMario Six return c->cmd(cmdtp, flag, argc, argv);
339*37c4a5f6SMario Six else
340*37c4a5f6SMario Six return CMD_RET_USAGE;
341*37c4a5f6SMario Six }
342*37c4a5f6SMario Six
343*37c4a5f6SMario Six static char axi_help_text[] =
344*37c4a5f6SMario Six "bus - show AXI bus info\n"
345*37c4a5f6SMario Six "axi dev [bus] - show or set current AXI bus to bus number [bus]\n"
346*37c4a5f6SMario Six "axi md size addr [# of objects] - read from AXI device at address [addr] and data width [size] (one of 8, 16, 32)\n"
347*37c4a5f6SMario Six "axi mw size addr value [count] - write data [value] to AXI device at address [addr] and data width [size] (one of 8, 16, 32)\n";
348*37c4a5f6SMario Six
349*37c4a5f6SMario Six U_BOOT_CMD(axi, 7, 1, do_ihs_axi,
350*37c4a5f6SMario Six "AXI sub-system",
351*37c4a5f6SMario Six axi_help_text
352*37c4a5f6SMario Six );
353