← Back to branch summary

~pmdj/ubuntu/trusty/qemu/2.9+applesmc+fadtv3

« back to all changes in this revision

Viewing changes to roms/u-boot/common/cmd_portio.c

  • Committer: Phil Dennis-Jordan
  • Date: 2017-07-21 08:03:43 UTC
  • mfrom: (1.1.1)
  • Revision ID: phil@philjordan.eu-20170721080343-2yr2vdj7713czahv
New upstream release 2.9.0.

Show diffs side-by-side

added added

removed removed

Lines of Context:
roms/u-boot/common/cmd_portio.c
 
1
/*
 
2
 * (C) Copyright 2003
 
3
 * Marc Singer, elf@buici.com
 
4
 *
 
5
 * SPDX-License-Identifier:     GPL-2.0+
 
6
 */
 
7
 
 
8
/*
 
9
 * Port I/O Functions
 
10
 *
 
11
 * Copied from FADS ROM, Dan Malek (dmalek@jlc.net)
 
12
 */
 
13
 
 
14
#include <common.h>
 
15
#include <command.h>
 
16
 
 
17
/* Display values from last command.
 
18
 * Memory modify remembered values are different from display memory.
 
19
 */
 
20
static uint in_last_addr, in_last_size;
 
21
static uint out_last_addr, out_last_size, out_last_value;
 
22
 
 
23
 
 
24
int do_portio_out (cmd_tbl_t * cmdtp, int flag, int argc, char * const argv[])
 
25
{
 
26
        uint addr = out_last_addr;
 
27
        uint size = out_last_size;
 
28
        uint value = out_last_value;
 
29
 
 
30
        if (argc != 3)
 
31
                return CMD_RET_USAGE;
 
32
 
 
33
        if ((flag & CMD_FLAG_REPEAT) == 0) {
 
34
                /*
 
35
                 * New command specified.  Check for a size specification.
 
36
                 * Defaults to long if no or incorrect specification.
 
37
                 */
 
38
                size = cmd_get_data_size (argv[0], 1);
 
39
                addr = simple_strtoul (argv[1], NULL, 16);
 
40
                value = simple_strtoul (argv[2], NULL, 16);
 
41
        }
 
42
#if defined (CONFIG_X86)
 
43
 
 
44
        {
 
45
                unsigned short port = addr;
 
46
 
 
47
                switch (size) {
 
48
                default:
 
49
                case 1:
 
50
                    {
 
51
                        unsigned char ch = value;
 
52
                        __asm__ volatile ("out %0, %%dx"::"a" (ch), "d" (port));
 
53
                    }
 
54
                        break;
 
55
                case 2:
 
56
                    {
 
57
                        unsigned short w = value;
 
58
                        __asm__ volatile ("out %0, %%dx"::"a" (w), "d" (port));
 
59
                    }
 
60
                        break;
 
61
                case 4:
 
62
                        __asm__ volatile ("out %0, %%dx"::"a" (value), "d" (port));
 
63
 
 
64
                        break;
 
65
                }
 
66
        }
 
67
 
 
68
#endif                                                  /* CONFIG_X86 */
 
69
 
 
70
        out_last_addr = addr;
 
71
        out_last_size = size;
 
72
        out_last_value = value;
 
73
 
 
74
        return 0;
 
75
}
 
76
 
 
77
U_BOOT_CMD(
 
78
        out,    3,      1,      do_portio_out,
 
79
        "write datum to IO port",
 
80
        "[.b, .w, .l] port value\n    - output to IO port"
 
81
);
 
82
 
 
83
int do_portio_in (cmd_tbl_t * cmdtp, int flag, int argc, char * const argv[])
 
84
{
 
85
        uint addr = in_last_addr;
 
86
        uint size = in_last_size;
 
87
 
 
88
        if (argc != 2)
 
89
                return CMD_RET_USAGE;
 
90
 
 
91
        if ((flag & CMD_FLAG_REPEAT) == 0) {
 
92
                /*
 
93
                 * New command specified.  Check for a size specification.
 
94
                 * Defaults to long if no or incorrect specification.
 
95
                 */
 
96
                size = cmd_get_data_size (argv[0], 1);
 
97
                addr = simple_strtoul (argv[1], NULL, 16);
 
98
        }
 
99
#if defined (CONFIG_X86)
 
100
 
 
101
        {
 
102
                unsigned short port = addr;
 
103
 
 
104
                switch (size) {
 
105
                default:
 
106
                case 1:
 
107
                    {
 
108
                        unsigned char ch;
 
109
                        __asm__ volatile ("in %%dx, %0":"=a" (ch):"d" (port));
 
110
 
 
111
                        printf (" %02x\n", ch);
 
112
                    }
 
113
                        break;
 
114
                case 2:
 
115
                    {
 
116
                        unsigned short w;
 
117
                        __asm__ volatile ("in %%dx, %0":"=a" (w):"d" (port));
 
118
 
 
119
                        printf (" %04x\n", w);
 
120
                    }
 
121
                        break;
 
122
                case 4:
 
123
                    {
 
124
                        unsigned long l;
 
125
                        __asm__ volatile ("in %%dx, %0":"=a" (l):"d" (port));
 
126
 
 
127
                        printf (" %08lx\n", l);
 
128
                    }
 
129
                        break;
 
130
                }
 
131
        }
 
132
#endif  /* CONFIG_X86 */
 
133
 
 
134
        in_last_addr = addr;
 
135
        in_last_size = size;
 
136
 
 
137
        return 0;
 
138
}
 
139
 
 
140
U_BOOT_CMD(
 
141
        in,     2,      1,      do_portio_in,
 
142
        "read data from an IO port",
 
143
        "[.b, .w, .l] port\n"
 
144
        "    - read datum from IO port"
 
145
);