1 /* 2 * TI OMAP L4 interconnect emulation. 3 * 4 * Copyright (C) 2007-2009 Nokia Corporation 5 * Written by Andrzej Zaborowski <andrew@openedhand.com> 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/hw.h" 21 #include "hw/arm/omap.h" 22 23 struct omap_l4_s { 24 MemoryRegion *address_space; 25 hwaddr base; 26 int ta_num; 27 struct omap_target_agent_s ta[0]; 28 }; 29 30 struct omap_l4_s *omap_l4_init(MemoryRegion *address_space, 31 hwaddr base, int ta_num) 32 { 33 struct omap_l4_s *bus = g_malloc0( 34 sizeof(*bus) + ta_num * sizeof(*bus->ta)); 35 36 bus->address_space = address_space; 37 bus->ta_num = ta_num; 38 bus->base = base; 39 40 return bus; 41 } 42 43 hwaddr omap_l4_region_base(struct omap_target_agent_s *ta, 44 int region) 45 { 46 return ta->bus->base + ta->start[region].offset; 47 } 48 49 hwaddr omap_l4_region_size(struct omap_target_agent_s *ta, 50 int region) 51 { 52 return ta->start[region].size; 53 } 54 55 static uint64_t omap_l4ta_read(void *opaque, hwaddr addr, 56 unsigned size) 57 { 58 struct omap_target_agent_s *s = (struct omap_target_agent_s *) opaque; 59 60 if (size != 2) { 61 return omap_badwidth_read16(opaque, addr); 62 } 63 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 79 static void omap_l4ta_write(void *opaque, hwaddr addr, 80 uint64_t value, unsigned size) 81 { 82 struct omap_target_agent_s *s = (struct omap_target_agent_s *) opaque; 83 84 if (size != 4) { 85 return omap_badwidth_write32(opaque, addr, value); 86 } 87 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 105 static const MemoryRegionOps omap_l4ta_ops = { 106 .read = omap_l4ta_read, 107 .write = omap_l4ta_write, 108 .endianness = DEVICE_NATIVE_ENDIAN, 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 { 116 int i; 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 139 memory_region_init_io(&ta->iomem, NULL, &omap_l4ta_ops, ta, "omap.l4ta", 140 omap_l4_region_size(ta, info->ta_region)); 141 omap_l4_attach(ta, info->ta_region, &ta->iomem); 142 143 return ta; 144 } 145 146 hwaddr omap_l4_attach(struct omap_target_agent_s *ta, 147 int region, MemoryRegion *mr) 148 { 149 hwaddr base; 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 } 163