1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
|
/*++
Copyright (c) 2010 WonderMedia Technologies, Inc.
This program is free software: you can redistribute it and/or modify it under
the terms of the GNU General Public License as published by the Free Software
Foundation, either version 2 of the License, or (at your option) any later version.
This program is distributed in the hope that it will be useful, but WITHOUT ANY
WARRANTY; without even the implied warranty of MERCHANTABILITY or FITNESS FOR A
PARTICULAR PURPOSE. See the GNU General Public License for more details. You
should have received a copy of the GNU General Public License along with this
program. If not, see http://www.gnu.org/licenses/>.
WonderMedia Technologies, Inc.
4F, 531, Chung-Cheng Road, Hsin-Tien, Taipei 231, R.O.C.
--*/
#include <config.h>
#include <common.h>
#include <command.h>
#include <version.h>
#include <stdarg.h>
#include <linux/types.h>
#include <devices.h>
#include <linux/stddef.h>
#include <asm/byteorder.h>
#include "wmt_display.h"
#include "com-vpp.h"
void excute_reg_op(char * p)
{
ulong addr;
ulong val, org;
char op;
char * endp;
while(1)
{
addr = simple_strtoul(p, &endp, 16);
if( *endp == '\0')
break;
op = *endp;
if( endp[1] == '~')
{
val = simple_strtoul(endp+2, &endp, 16);
val = ~val;
}
else
{
val = simple_strtoul(endp+1, &endp, 16);
}
if (addr&0x03) {
printf(" address not alginment to 32bit , address = 0x%x\n",addr);
goto nextcheck;
}
printf(" reg op: 0x%X %c 0x%X\n", addr, op, val);
org = REG32_VAL(addr);
switch(op)
{
case '|': org |= val; break;
case '=': org = val ; break;
case '&': org &= val; break;
default:
printf("Error, Unknown operator %c\n", op);
break;
}
REG32_VAL(addr) = org;
nextcheck:
if(*endp == '\0')
break;
p = endp + 1;
}
return;
}
static int wmt_do_mbit (cmd_tbl_t * cmdtp, int flag, int argc, char *argv[])
{
switch (argc) {
case 0:
case 1:
printf ("Usage:\n%s\n", cmdtp->usage);
return 0;
default:
if (argc == 2) {
excute_reg_op(argv[1]);
return 0;
}
printf ("Usage:\n%s\n", cmdtp->usage);
return 0;
}
return 0;
}
U_BOOT_CMD(
mbit, 2, 1, wmt_do_mbit,
"memory bit operation : \n"
"Format : mbit <parameter>\n",
"Puepose : write bit to memory\n"
"Example : mbit -int D8000012|~1\n"
" VAL32(0xD8000012) | 0xFFFFFFFE"
);
|
