cmd/demo.c

   1 // SPDX-License-Identifier: GPL-2.0+
   2 /*
   3  * Copyright (c) 2013 Google, Inc
   4  *
   5  * (C) Copyright 2012
   6  * Pavel Herrmann <[email protected]>
   7  */
   8
   9 #include <command.h>
  10 #include <dm.h>
  11 #include <dm-demo.h>
  12 #include <mapmem.h>
  13 #include <asm/io.h>
  14
  15 struct udevice *demo_dev;
  16
  17 static int do_demo_hello(struct cmd_tbl *cmdtp, int flag, int argc,
  18                          char *const argv[])
  19 {
  20         int ch = 0;
  21
  22         if (argc)
  23                 ch = *argv[0];
  24
  25         return demo_hello(demo_dev, ch);
  26 }
  27
  28 static int do_demo_status(struct cmd_tbl *cmdtp, int flag, int argc,
  29                           char *const argv[])
  30 {
  31         int status;
  32         int ret;
  33
  34         ret = demo_status(demo_dev, &status);
  35         if (ret)
  36                 return ret;
  37
  38         printf("Status: %d\n", status);
  39
  40         return 0;
  41 }
  42
  43 static int do_demo_light(struct cmd_tbl *cmdtp, int flag, int argc,
  44                          char *const argv[])
  45 {
  46         int light;
  47         int ret;
  48
  49         if (argc) {
  50                 light = hextoul(argv[0], NULL);
  51                 ret = demo_set_light(demo_dev, light);
  52         } else {
  53                 ret = demo_get_light(demo_dev);
  54                 if (ret >= 0) {
  55                         printf("Light: %x\n", ret);
  56                         ret = 0;
  57                 }
  58         }
  59
  60         return ret;
  61 }
  62
  63 int do_demo_list(struct cmd_tbl *cmdtp, int flag, int argc, char *const argv[])
  64 {
  65         struct udevice *dev;
  66         int i, ret, err = 0;
  67
  68         puts("Demo uclass entries:\n");
  69
  70         for (i = 0, ret = uclass_first_device_check(UCLASS_DEMO, &dev);
  71              dev;
  72              ret = uclass_next_device_check(&dev)) {
  73                 printf("entry %d - instance %08x, ops %08x, plat %08x, status %i\n",
  74                        i++, (uint)map_to_sysmem(dev),
  75                        (uint)map_to_sysmem(dev->driver->ops),
  76                        (uint)map_to_sysmem(dev_get_plat(dev)),
  77                        ret);
  78                 if (ret)
  79                         err = ret;
  80         }
  81
  82         return cmd_process_error(cmdtp, err);
  83 }
  84
  85 static struct cmd_tbl demo_commands[] = {
  86         U_BOOT_CMD_MKENT(list, 0, 1, do_demo_list, "", ""),
  87         U_BOOT_CMD_MKENT(hello, 2, 1, do_demo_hello, "", ""),
  88         U_BOOT_CMD_MKENT(light, 2, 1, do_demo_light, "", ""),
  89         U_BOOT_CMD_MKENT(status, 1, 1, do_demo_status, "", ""),
  90 };
  91
  92 static int do_demo(struct cmd_tbl *cmdtp, int flag, int argc,
  93                    char *const argv[])
  94 {
  95         struct cmd_tbl *demo_cmd;
  96         int devnum = 0;
  97         int ret;
  98
  99         if (argc < 2)
 100                 return CMD_RET_USAGE;
 101         demo_cmd = find_cmd_tbl(argv[1], demo_commands,
 102                                 ARRAY_SIZE(demo_commands));
 103         argc -= 2;
 104         argv += 2;
 105
 106         if ((!demo_cmd || argc > demo_cmd->maxargs) ||
 107             ((demo_cmd->name[0] != 'l') && (argc < 1)))
 108                 return CMD_RET_USAGE;
 109
 110         if (argc) {
 111                 devnum = dectoul(argv[0], NULL);
 112                 ret = uclass_get_device(UCLASS_DEMO, devnum, &demo_dev);
 113                 if (ret)
 114                         return cmd_process_error(cmdtp, ret);
 115                 argc--;
 116                 argv++;
 117         } else {
 118                 demo_dev = NULL;
 119                 if (demo_cmd->cmd != do_demo_list)
 120                         return CMD_RET_USAGE;
 121         }
 122
 123         ret = demo_cmd->cmd(demo_cmd, flag, argc, argv);
 124
 125         return cmd_process_error(demo_cmd, ret);
 126 }
 127
 128 U_BOOT_CMD(
 129         demo,   4,      1,      do_demo,
 130         "Driver model (dm) demo operations",
 131         "list                     List available demo devices\n"
 132         "demo hello <num> [<char>]     Say hello\n"
 133         "demo light [<num>]            Set or get the lights\n"
 134         "demo status <num>             Get demo device status\n"
 135 );