]>
Commit | Line | Data |
---|---|---|
2c1d9ecb | 1 | /* |
2 | * TI OMAP L4 interconnect emulation. | |
3 | * | |
4 | * Copyright (C) 2007-2009 Nokia Corporation | |
5 | * Written by Andrzej Zaborowski <[email protected]> | |
6 | * | |
7 | * This program is free software; you can redistribute it and/or | |
8 | * modify it under the terms of the GNU General Public License as | |
9 | * published by the Free Software Foundation; either version 2 or | |
10 | * (at your option) any later version of the License. | |
11 | * | |
12 | * This program is distributed in the hope that it will be useful, | |
13 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | |
14 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
15 | * GNU General Public License for more details. | |
16 | * | |
17 | * You should have received a copy of the GNU General Public License along | |
18 | * with this program; if not, see <http://www.gnu.org/licenses/>. | |
19 | */ | |
20 | #include "hw.h" | |
21 | #include "omap.h" | |
22 | ||
2c1d9ecb | 23 | struct omap_l4_s { |
f3226149 | 24 | MemoryRegion *address_space; |
a8170e5e | 25 | hwaddr base; |
2c1d9ecb | 26 | int ta_num; |
27 | struct omap_target_agent_s ta[0]; | |
28 | }; | |
29 | ||
f3226149 | 30 | struct omap_l4_s *omap_l4_init(MemoryRegion *address_space, |
a8170e5e | 31 | hwaddr base, int ta_num) |
2c1d9ecb | 32 | { |
7267c094 | 33 | struct omap_l4_s *bus = g_malloc0( |
2c1d9ecb | 34 | sizeof(*bus) + ta_num * sizeof(*bus->ta)); |
35 | ||
f3226149 | 36 | bus->address_space = address_space; |
2c1d9ecb | 37 | bus->ta_num = ta_num; |
38 | bus->base = base; | |
39 | ||
2c1d9ecb | 40 | return bus; |
41 | } | |
42 | ||
a8170e5e | 43 | hwaddr omap_l4_region_base(struct omap_target_agent_s *ta, |
f9049203 JR |
44 | int region) |
45 | { | |
46 | return ta->bus->base + ta->start[region].offset; | |
47 | } | |
48 | ||
a8170e5e | 49 | hwaddr omap_l4_region_size(struct omap_target_agent_s *ta, |
f3226149 AK |
50 | int region) |
51 | { | |
52 | return ta->start[region].size; | |
53 | } | |
54 | ||
a8170e5e | 55 | static uint64_t omap_l4ta_read(void *opaque, hwaddr addr, |
3892f842 | 56 | unsigned size) |
2c1d9ecb | 57 | { |
58 | struct omap_target_agent_s *s = (struct omap_target_agent_s *) opaque; | |
59 | ||
3892f842 BC |
60 | if (size != 2) { |
61 | return omap_badwidth_read16(opaque, addr); | |
62 | } | |
63 | ||
2c1d9ecb | 64 | switch (addr) { |
65 | case 0x00: /* COMPONENT */ | |
66 | return s->component; | |
67 | ||
68 | case 0x20: /* AGENT_CONTROL */ | |
69 | return s->control; | |
70 | ||
71 | case 0x28: /* AGENT_STATUS */ | |
72 | return s->status; | |
73 | } | |
74 | ||
75 | OMAP_BAD_REG(addr); | |
76 | return 0; | |
77 | } | |
78 | ||
a8170e5e | 79 | static void omap_l4ta_write(void *opaque, hwaddr addr, |
3892f842 | 80 | uint64_t value, unsigned size) |
2c1d9ecb | 81 | { |
82 | struct omap_target_agent_s *s = (struct omap_target_agent_s *) opaque; | |
83 | ||
3892f842 BC |
84 | if (size != 4) { |
85 | return omap_badwidth_write32(opaque, addr, value); | |
86 | } | |
87 | ||
2c1d9ecb | 88 | switch (addr) { |
89 | case 0x00: /* COMPONENT */ | |
90 | case 0x28: /* AGENT_STATUS */ | |
91 | OMAP_RO_REG(addr); | |
92 | break; | |
93 | ||
94 | case 0x20: /* AGENT_CONTROL */ | |
95 | s->control = value & 0x01000700; | |
96 | if (value & 1) /* OCP_RESET */ | |
97 | s->status &= ~1; /* REQ_TIMEOUT */ | |
98 | break; | |
99 | ||
100 | default: | |
101 | OMAP_BAD_REG(addr); | |
102 | } | |
103 | } | |
104 | ||
3892f842 BC |
105 | static const MemoryRegionOps omap_l4ta_ops = { |
106 | .read = omap_l4ta_read, | |
107 | .write = omap_l4ta_write, | |
108 | .endianness = DEVICE_NATIVE_ENDIAN, | |
2c1d9ecb | 109 | }; |
110 | ||
111 | struct omap_target_agent_s *omap_l4ta_get(struct omap_l4_s *bus, | |
112 | const struct omap_l4_region_s *regions, | |
113 | const struct omap_l4_agent_info_s *agents, | |
114 | int cs) | |
115 | { | |
3892f842 | 116 | int i; |
2c1d9ecb | 117 | struct omap_target_agent_s *ta = NULL; |
118 | const struct omap_l4_agent_info_s *info = NULL; | |
119 | ||
120 | for (i = 0; i < bus->ta_num; i ++) | |
121 | if (agents[i].ta == cs) { | |
122 | ta = &bus->ta[i]; | |
123 | info = &agents[i]; | |
124 | break; | |
125 | } | |
126 | if (!ta) { | |
127 | fprintf(stderr, "%s: bad target agent (%i)\n", __FUNCTION__, cs); | |
128 | exit(-1); | |
129 | } | |
130 | ||
131 | ta->bus = bus; | |
132 | ta->start = ®ions[info->region]; | |
133 | ta->regions = info->regions; | |
134 | ||
135 | ta->component = ('Q' << 24) | ('E' << 16) | ('M' << 8) | ('U' << 0); | |
136 | ta->status = 0x00000000; | |
137 | ta->control = 0x00000200; /* XXX 01000200 for L4TAO */ | |
138 | ||
3892f842 BC |
139 | memory_region_init_io(&ta->iomem, &omap_l4ta_ops, ta, "omap.l4ta", |
140 | omap_l4_region_size(ta, info->ta_region)); | |
f44336c5 | 141 | omap_l4_attach(ta, info->ta_region, &ta->iomem); |
2c1d9ecb | 142 | |
143 | return ta; | |
144 | } | |
145 | ||
a8170e5e | 146 | hwaddr omap_l4_attach(struct omap_target_agent_s *ta, |
f3226149 AK |
147 | int region, MemoryRegion *mr) |
148 | { | |
a8170e5e | 149 | hwaddr base; |
f3226149 AK |
150 | |
151 | if (region < 0 || region >= ta->regions) { | |
152 | fprintf(stderr, "%s: bad io region (%i)\n", __FUNCTION__, region); | |
153 | exit(-1); | |
154 | } | |
155 | ||
156 | base = ta->bus->base + ta->start[region].offset; | |
157 | if (mr) { | |
158 | memory_region_add_subregion(ta->bus->address_space, base, mr); | |
159 | } | |
160 | ||
161 | return base; | |
162 | } |