board/gdsys/common/osd_cmd.c

   1 // SPDX-License-Identifier: GPL-2.0+
   2 /*
   3  * (C) Copyright 2017
   4  * Mario Six,  Guntermann & Drunck GmbH, mario.six@gdsys.cc
   5  *
   6  * based on the gdsys osd driver, which is
   7  *
   8  * (C) Copyright 2010
   9  * Dirk Eibach,  Guntermann & Drunck GmbH, eibach@gdsys.de
  10  */
  11
  12 #include <common.h>
  13 #include <command.h>
  14 #include <dm.h>
  15 #include <hexdump.h>
  16 #include <video_osd.h>
  17 #include <malloc.h>
  18
  19 static int do_osd_write(struct cmd_tbl *cmdtp, int flag, int argc,
  20                         char *const argv[])
  21 {
  22         struct udevice *dev;
  23         uint x, y;
  24         uint count;
  25         char *hexstr;
  26         u8 *buffer;
  27         size_t buflen;
  28         int res;
  29
  30         if (argc < 4 || (strlen(argv[3])) % 2)
  31                 return CMD_RET_USAGE;
  32
  33         x = simple_strtoul(argv[1], NULL, 16);
  34         y = simple_strtoul(argv[2], NULL, 16);
  35         hexstr = argv[3];
  36         count = (argc > 4) ? simple_strtoul(argv[4], NULL, 16) : 1;
  37
  38         buflen = strlen(hexstr) / 2;
  39
  40         buffer = malloc(buflen);
  41         if (!buffer) {
  42                 puts("Memory allocation failure\n");
  43                 return CMD_RET_FAILURE;
  44         }
  45
  46         res = hex2bin(buffer, hexstr, buflen);
  47         if (res) {
  48                 free(buffer);
  49                 puts("Hexadecimal input contained invalid characters\n");
  50                 return CMD_RET_FAILURE;
  51         }
  52
  53         for (uclass_first_device(UCLASS_VIDEO_OSD, &dev);
  54              dev;
  55              uclass_next_device(&dev)) {
  56                 int res;
  57
  58                 res = video_osd_set_mem(dev, x, y, buffer, buflen, count);
  59                 if (res) {
  60                         free(buffer);
  61                         printf("Could not write to video mem on osd %s\n",
  62                                dev->name);
  63                         return CMD_RET_FAILURE;
  64                 }
  65         }
  66
  67         free(buffer);
  68
  69         return CMD_RET_SUCCESS;
  70 }
  71
  72 static int do_osd_print(struct cmd_tbl *cmdtp, int flag, int argc,
  73                         char *const argv[])
  74 {
  75         struct udevice *dev;
  76         uint x, y;
  77         u8 color;
  78         char *text;
  79
  80         if (argc < 5)
  81                 return CMD_RET_USAGE;
  82
  83         x = simple_strtoul(argv[1], NULL, 16);
  84         y = simple_strtoul(argv[2], NULL, 16);
  85         color = simple_strtoul(argv[3], NULL, 16);
  86         text = argv[4];
  87
  88         for (uclass_first_device(UCLASS_VIDEO_OSD, &dev);
  89              dev;
  90              uclass_next_device(&dev)) {
  91                 int res;
  92
  93                 res = video_osd_print(dev, x, y, color, text);
  94                 if (res) {
  95                         printf("Could not print string to osd %s\n", dev->name);
  96                         return CMD_RET_FAILURE;
  97                 }
  98         }
  99
 100         return CMD_RET_SUCCESS;
 101 }
 102
 103 static int do_osd_size(struct cmd_tbl *cmdtp, int flag, int argc,
 104                        char *const argv[])
 105 {
 106         struct udevice *dev;
 107         uint x, y;
 108
 109         if (argc < 3)
 110                 return CMD_RET_USAGE;
 111
 112         x = simple_strtoul(argv[1], NULL, 16);
 113         y = simple_strtoul(argv[2], NULL, 16);
 114
 115         for (uclass_first_device(UCLASS_VIDEO_OSD, &dev);
 116              dev;
 117              uclass_next_device(&dev)) {
 118                 int res;
 119
 120                 res = video_osd_set_size(dev, x, y);
 121
 122                 if (res) {
 123                         printf("Could not set size on osd %s\n", dev->name);
 124                         return CMD_RET_FAILURE;
 125                 }
 126         }
 127
 128         return CMD_RET_SUCCESS;
 129 }
 130
 131 U_BOOT_CMD(
 132         osdw, 5, 0, do_osd_write,
 133         "write 16-bit hex encoded buffer to osd memory",
 134         "osdw [pos_x] [pos_y] [buffer] [count] - write 8-bit hex encoded buffer to osd memory\n"
 135 );
 136
 137 U_BOOT_CMD(
 138         osdp, 5, 0, do_osd_print,
 139         "write ASCII buffer to osd memory",
 140         "osdp [pos_x] [pos_y] [color] [text] - write ASCII buffer to osd memory\n"
 141 );
 142
 143 U_BOOT_CMD(
 144         osdsize, 3, 0, do_osd_size,
 145         "set OSD XY size in characters",
 146         "osdsize [size_x] [size_y] - set OSD XY size in characters\n"
 147 );