LXR uboot/common/cmd

   1/*
   2 * (C) Copyright 2003
   3 * Marc Singer, elf@buici.com
   4 *
   5 * See file CREDITS for list of people who contributed to this
   6 * project.
   7 *
   8 * This program is free software; you can redistribute it and/or
   9 * modify it under the terms of the GNU General Public License as
  10 * published by the Free Software Foundation; either version 2 of
  11 * the License, or (at your option) any later version.
  12 *
  13 * This program is distributed in the hope that it will be useful,
  14 * but WITHOUT ANY WARRANTY; without even the implied warranty of
  15 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  16 * GNU General Public License for more details.
  17 *
  18 * You should have received a copy of the GNU General Public License
  19 * along with this program; if not, write to the Free Software
  20 * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
  21 * MA 02111-1307 USA
  22 */
  23
  24/*
  25 * Port I/O Functions
  26 *
  27 * Copied from FADS ROM, Dan Malek (dmalek@jlc.net)
  28 */
  29
  30#include <common.h>
  31#include <command.h>
  32
  33extern int cmd_get_data_size (char *arg, int default_size);
  34
  35/* Display values from last command.
  36 * Memory modify remembered values are different from display memory.
  37 */
  38static uint in_last_addr, in_last_size;
  39static uint out_last_addr, out_last_size, out_last_value;
  40
  41
  42int do_portio_out (cmd_tbl_t * cmdtp, int flag, int argc, char *argv[])
  43{
  44        uint addr = out_last_addr;
  45        uint size = out_last_size;
  46        uint value = out_last_value;
  47
  48        if (argc != 3) {
  49                printf ("Usage:\n%s\n", cmdtp->usage);
  50                return 1;
  51        }
  52
  53        if ((flag & CMD_FLAG_REPEAT) == 0) {
  54                /* New command specified.  Check for a size specification.
  55                 * Defaults to long if no or incorrect specification.
  56                 */
  57                size = cmd_get_data_size (argv[0], 1);
  58                addr = simple_strtoul (argv[1], NULL, 16);
  59                value = simple_strtoul (argv[2], NULL, 16);
  60        }
  61#if defined (CONFIG_X86)
  62
  63        {
  64                unsigned short port = addr;
  65
  66                switch (size) {
  67                default:
  68                case 1:
  69                    {
  70                        unsigned char ch = value;
  71                        __asm__ volatile ("out %0, %%dx"::"a" (ch), "d" (port));
  72                    }
  73                        break;
  74                case 2:
  75                    {
  76                        unsigned short w = value;
  77                        __asm__ volatile ("out %0, %%dx"::"a" (w), "d" (port));
  78                    }
  79                        break;
  80                case 4:
  81                        __asm__ volatile ("out %0, %%dx"::"a" (value), "d" (port));
  82
  83                        break;
  84                }
  85        }
  86
  87#endif                                                  /* CONFIG_X86 */
  88
  89        out_last_addr = addr;
  90        out_last_size = size;
  91        out_last_value = value;
  92
  93        return 0;
  94}
  95
  96U_BOOT_CMD(
  97        out,    3,      1,      do_portio_out,
  98        "out     - write datum to IO port\n",
  99        "[.b, .w, .l] port value\n    - output to IO port\n"
 100);
 101
 102int do_portio_in (cmd_tbl_t * cmdtp, int flag, int argc, char *argv[])
 103{
 104        uint addr = in_last_addr;
 105        uint size = in_last_size;
 106
 107        if (argc != 2) {
 108                printf ("Usage:\n%s\n", cmdtp->usage);
 109                return 1;
 110        }
 111
 112        if ((flag & CMD_FLAG_REPEAT) == 0) {
 113                /* New command specified.  Check for a size specification.
 114                 * Defaults to long if no or incorrect specification.
 115                 */
 116                size = cmd_get_data_size (argv[0], 1);
 117                addr = simple_strtoul (argv[1], NULL, 16);
 118        }
 119#if defined (CONFIG_X86)
 120
 121        {
 122                unsigned short port = addr;
 123
 124                switch (size) {
 125                default:
 126                case 1:
 127                    {
 128                        unsigned char ch;
 129                        __asm__ volatile ("in %%dx, %0":"=a" (ch):"d" (port));
 130
 131                        printf (" %02x\n", ch);
 132                    }
 133                        break;
 134                case 2:
 135                    {
 136                        unsigned short w;
 137                        __asm__ volatile ("in %%dx, %0":"=a" (w):"d" (port));
 138
 139                        printf (" %04x\n", w);
 140                    }
 141                        break;
 142                case 4:
 143                    {
 144                        unsigned long l;
 145                        __asm__ volatile ("in %%dx, %0":"=a" (l):"d" (port));
 146
 147                        printf (" %08lx\n", l);
 148                    }
 149                        break;
 150                }
 151        }
 152#endif  /* CONFIG_X86 */
 153
 154        in_last_addr = addr;
 155        in_last_size = size;
 156
 157        return 0;
 158}
 159
 160U_BOOT_CMD(
 161        in,     2,      1,      do_portio_in,
 162        "in      - read data from an IO port\n",
 163        "[.b, .w, .l] port\n"
 164        "    - read datum from IO port\n"
 165);
 166