c66fb5bc0a
git-svn-id: svn://svn.savannah.nongnu.org/qemu/trunk@4489 c046a42c-6fe2-441c-8c8c-71466251a162
4180 lines
124 KiB
C
4180 lines
124 KiB
C
/*
|
|
* TI OMAP processors emulation.
|
|
*
|
|
* Copyright (C) 2007-2008 Nokia Corporation
|
|
* Written by Andrzej Zaborowski <andrew@openedhand.com>
|
|
*
|
|
* 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 or
|
|
* (at your option) version 3 of the License.
|
|
*
|
|
* 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, write to the Free Software
|
|
* Foundation, Inc., 59 Temple Place, Suite 330, Boston,
|
|
* MA 02111-1307 USA
|
|
*/
|
|
#include "hw.h"
|
|
#include "arm-misc.h"
|
|
#include "omap.h"
|
|
#include "sysemu.h"
|
|
#include "qemu-timer.h"
|
|
#include "qemu-char.h"
|
|
#include "flash.h"
|
|
|
|
/* GP timers */
|
|
struct omap_gp_timer_s {
|
|
qemu_irq irq;
|
|
qemu_irq wkup;
|
|
qemu_irq in;
|
|
qemu_irq out;
|
|
omap_clk clk;
|
|
target_phys_addr_t base;
|
|
QEMUTimer *timer;
|
|
QEMUTimer *match;
|
|
struct omap_target_agent_s *ta;
|
|
|
|
int in_val;
|
|
int out_val;
|
|
int64_t time;
|
|
int64_t rate;
|
|
int64_t ticks_per_sec;
|
|
|
|
int16_t config;
|
|
int status;
|
|
int it_ena;
|
|
int wu_ena;
|
|
int enable;
|
|
int inout;
|
|
int capt2;
|
|
int pt;
|
|
enum {
|
|
gpt_trigger_none, gpt_trigger_overflow, gpt_trigger_both
|
|
} trigger;
|
|
enum {
|
|
gpt_capture_none, gpt_capture_rising,
|
|
gpt_capture_falling, gpt_capture_both
|
|
} capture;
|
|
int scpwm;
|
|
int ce;
|
|
int pre;
|
|
int ptv;
|
|
int ar;
|
|
int st;
|
|
int posted;
|
|
uint32_t val;
|
|
uint32_t load_val;
|
|
uint32_t capture_val[2];
|
|
uint32_t match_val;
|
|
int capt_num;
|
|
|
|
uint16_t writeh; /* LSB */
|
|
uint16_t readh; /* MSB */
|
|
};
|
|
|
|
#define GPT_TCAR_IT (1 << 2)
|
|
#define GPT_OVF_IT (1 << 1)
|
|
#define GPT_MAT_IT (1 << 0)
|
|
|
|
static inline void omap_gp_timer_intr(struct omap_gp_timer_s *timer, int it)
|
|
{
|
|
if (timer->it_ena & it) {
|
|
if (!timer->status)
|
|
qemu_irq_raise(timer->irq);
|
|
|
|
timer->status |= it;
|
|
/* Or are the status bits set even when masked?
|
|
* i.e. is masking applied before or after the status register? */
|
|
}
|
|
|
|
if (timer->wu_ena & it)
|
|
qemu_irq_pulse(timer->wkup);
|
|
}
|
|
|
|
static inline void omap_gp_timer_out(struct omap_gp_timer_s *timer, int level)
|
|
{
|
|
if (!timer->inout && timer->out_val != level) {
|
|
timer->out_val = level;
|
|
qemu_set_irq(timer->out, level);
|
|
}
|
|
}
|
|
|
|
static inline uint32_t omap_gp_timer_read(struct omap_gp_timer_s *timer)
|
|
{
|
|
uint64_t distance;
|
|
|
|
if (timer->st && timer->rate) {
|
|
distance = qemu_get_clock(vm_clock) - timer->time;
|
|
distance = muldiv64(distance, timer->rate, timer->ticks_per_sec);
|
|
|
|
if (distance >= 0xffffffff - timer->val)
|
|
return 0xffffffff;
|
|
else
|
|
return timer->val + distance;
|
|
} else
|
|
return timer->val;
|
|
}
|
|
|
|
static inline void omap_gp_timer_sync(struct omap_gp_timer_s *timer)
|
|
{
|
|
if (timer->st) {
|
|
timer->val = omap_gp_timer_read(timer);
|
|
timer->time = qemu_get_clock(vm_clock);
|
|
}
|
|
}
|
|
|
|
static inline void omap_gp_timer_update(struct omap_gp_timer_s *timer)
|
|
{
|
|
int64_t expires, matches;
|
|
|
|
if (timer->st && timer->rate) {
|
|
expires = muldiv64(0x100000000ll - timer->val,
|
|
timer->ticks_per_sec, timer->rate);
|
|
qemu_mod_timer(timer->timer, timer->time + expires);
|
|
|
|
if (timer->ce && timer->match_val >= timer->val) {
|
|
matches = muldiv64(timer->match_val - timer->val,
|
|
timer->ticks_per_sec, timer->rate);
|
|
qemu_mod_timer(timer->match, timer->time + matches);
|
|
} else
|
|
qemu_del_timer(timer->match);
|
|
} else {
|
|
qemu_del_timer(timer->timer);
|
|
qemu_del_timer(timer->match);
|
|
omap_gp_timer_out(timer, timer->scpwm);
|
|
}
|
|
}
|
|
|
|
static inline void omap_gp_timer_trigger(struct omap_gp_timer_s *timer)
|
|
{
|
|
if (timer->pt)
|
|
/* TODO in overflow-and-match mode if the first event to
|
|
* occurs is the match, don't toggle. */
|
|
omap_gp_timer_out(timer, !timer->out_val);
|
|
else
|
|
/* TODO inverted pulse on timer->out_val == 1? */
|
|
qemu_irq_pulse(timer->out);
|
|
}
|
|
|
|
static void omap_gp_timer_tick(void *opaque)
|
|
{
|
|
struct omap_gp_timer_s *timer = (struct omap_gp_timer_s *) opaque;
|
|
|
|
if (!timer->ar) {
|
|
timer->st = 0;
|
|
timer->val = 0;
|
|
} else {
|
|
timer->val = timer->load_val;
|
|
timer->time = qemu_get_clock(vm_clock);
|
|
}
|
|
|
|
if (timer->trigger == gpt_trigger_overflow ||
|
|
timer->trigger == gpt_trigger_both)
|
|
omap_gp_timer_trigger(timer);
|
|
|
|
omap_gp_timer_intr(timer, GPT_OVF_IT);
|
|
omap_gp_timer_update(timer);
|
|
}
|
|
|
|
static void omap_gp_timer_match(void *opaque)
|
|
{
|
|
struct omap_gp_timer_s *timer = (struct omap_gp_timer_s *) opaque;
|
|
|
|
if (timer->trigger == gpt_trigger_both)
|
|
omap_gp_timer_trigger(timer);
|
|
|
|
omap_gp_timer_intr(timer, GPT_MAT_IT);
|
|
}
|
|
|
|
static void omap_gp_timer_input(void *opaque, int line, int on)
|
|
{
|
|
struct omap_gp_timer_s *s = (struct omap_gp_timer_s *) opaque;
|
|
int trigger;
|
|
|
|
switch (s->capture) {
|
|
default:
|
|
case gpt_capture_none:
|
|
trigger = 0;
|
|
break;
|
|
case gpt_capture_rising:
|
|
trigger = !s->in_val && on;
|
|
break;
|
|
case gpt_capture_falling:
|
|
trigger = s->in_val && !on;
|
|
break;
|
|
case gpt_capture_both:
|
|
trigger = (s->in_val == !on);
|
|
break;
|
|
}
|
|
s->in_val = on;
|
|
|
|
if (s->inout && trigger && s->capt_num < 2) {
|
|
s->capture_val[s->capt_num] = omap_gp_timer_read(s);
|
|
|
|
if (s->capt2 == s->capt_num ++)
|
|
omap_gp_timer_intr(s, GPT_TCAR_IT);
|
|
}
|
|
}
|
|
|
|
static void omap_gp_timer_clk_update(void *opaque, int line, int on)
|
|
{
|
|
struct omap_gp_timer_s *timer = (struct omap_gp_timer_s *) opaque;
|
|
|
|
omap_gp_timer_sync(timer);
|
|
timer->rate = on ? omap_clk_getrate(timer->clk) : 0;
|
|
omap_gp_timer_update(timer);
|
|
}
|
|
|
|
static void omap_gp_timer_clk_setup(struct omap_gp_timer_s *timer)
|
|
{
|
|
omap_clk_adduser(timer->clk,
|
|
qemu_allocate_irqs(omap_gp_timer_clk_update, timer, 1)[0]);
|
|
timer->rate = omap_clk_getrate(timer->clk);
|
|
}
|
|
|
|
static void omap_gp_timer_reset(struct omap_gp_timer_s *s)
|
|
{
|
|
s->config = 0x000;
|
|
s->status = 0;
|
|
s->it_ena = 0;
|
|
s->wu_ena = 0;
|
|
s->inout = 0;
|
|
s->capt2 = 0;
|
|
s->capt_num = 0;
|
|
s->pt = 0;
|
|
s->trigger = gpt_trigger_none;
|
|
s->capture = gpt_capture_none;
|
|
s->scpwm = 0;
|
|
s->ce = 0;
|
|
s->pre = 0;
|
|
s->ptv = 0;
|
|
s->ar = 0;
|
|
s->st = 0;
|
|
s->posted = 1;
|
|
s->val = 0x00000000;
|
|
s->load_val = 0x00000000;
|
|
s->capture_val[0] = 0x00000000;
|
|
s->capture_val[1] = 0x00000000;
|
|
s->match_val = 0x00000000;
|
|
omap_gp_timer_update(s);
|
|
}
|
|
|
|
static uint32_t omap_gp_timer_readw(void *opaque, target_phys_addr_t addr)
|
|
{
|
|
struct omap_gp_timer_s *s = (struct omap_gp_timer_s *) opaque;
|
|
int offset = addr - s->base;
|
|
|
|
switch (offset) {
|
|
case 0x00: /* TIDR */
|
|
return 0x21;
|
|
|
|
case 0x10: /* TIOCP_CFG */
|
|
return s->config;
|
|
|
|
case 0x14: /* TISTAT */
|
|
/* ??? When's this bit reset? */
|
|
return 1; /* RESETDONE */
|
|
|
|
case 0x18: /* TISR */
|
|
return s->status;
|
|
|
|
case 0x1c: /* TIER */
|
|
return s->it_ena;
|
|
|
|
case 0x20: /* TWER */
|
|
return s->wu_ena;
|
|
|
|
case 0x24: /* TCLR */
|
|
return (s->inout << 14) |
|
|
(s->capt2 << 13) |
|
|
(s->pt << 12) |
|
|
(s->trigger << 10) |
|
|
(s->capture << 8) |
|
|
(s->scpwm << 7) |
|
|
(s->ce << 6) |
|
|
(s->pre << 5) |
|
|
(s->ptv << 2) |
|
|
(s->ar << 1) |
|
|
(s->st << 0);
|
|
|
|
case 0x28: /* TCRR */
|
|
return omap_gp_timer_read(s);
|
|
|
|
case 0x2c: /* TLDR */
|
|
return s->load_val;
|
|
|
|
case 0x30: /* TTGR */
|
|
return 0xffffffff;
|
|
|
|
case 0x34: /* TWPS */
|
|
return 0x00000000; /* No posted writes pending. */
|
|
|
|
case 0x38: /* TMAR */
|
|
return s->match_val;
|
|
|
|
case 0x3c: /* TCAR1 */
|
|
return s->capture_val[0];
|
|
|
|
case 0x40: /* TSICR */
|
|
return s->posted << 2;
|
|
|
|
case 0x44: /* TCAR2 */
|
|
return s->capture_val[1];
|
|
}
|
|
|
|
OMAP_BAD_REG(addr);
|
|
return 0;
|
|
}
|
|
|
|
static uint32_t omap_gp_timer_readh(void *opaque, target_phys_addr_t addr)
|
|
{
|
|
struct omap_gp_timer_s *s = (struct omap_gp_timer_s *) opaque;
|
|
uint32_t ret;
|
|
|
|
if (addr & 2)
|
|
return s->readh;
|
|
else {
|
|
ret = omap_gp_timer_readw(opaque, addr);
|
|
s->readh = ret >> 16;
|
|
return ret & 0xffff;
|
|
}
|
|
}
|
|
|
|
static CPUReadMemoryFunc *omap_gp_timer_readfn[] = {
|
|
omap_badwidth_read32,
|
|
omap_gp_timer_readh,
|
|
omap_gp_timer_readw,
|
|
};
|
|
|
|
static void omap_gp_timer_write(void *opaque, target_phys_addr_t addr,
|
|
uint32_t value)
|
|
{
|
|
struct omap_gp_timer_s *s = (struct omap_gp_timer_s *) opaque;
|
|
int offset = addr - s->base;
|
|
|
|
switch (offset) {
|
|
case 0x00: /* TIDR */
|
|
case 0x14: /* TISTAT */
|
|
case 0x34: /* TWPS */
|
|
case 0x3c: /* TCAR1 */
|
|
case 0x44: /* TCAR2 */
|
|
OMAP_RO_REG(addr);
|
|
break;
|
|
|
|
case 0x10: /* TIOCP_CFG */
|
|
s->config = value & 0x33d;
|
|
if (((value >> 3) & 3) == 3) /* IDLEMODE */
|
|
fprintf(stderr, "%s: illegal IDLEMODE value in TIOCP_CFG\n",
|
|
__FUNCTION__);
|
|
if (value & 2) /* SOFTRESET */
|
|
omap_gp_timer_reset(s);
|
|
break;
|
|
|
|
case 0x18: /* TISR */
|
|
if (value & GPT_TCAR_IT)
|
|
s->capt_num = 0;
|
|
if (s->status && !(s->status &= ~value))
|
|
qemu_irq_lower(s->irq);
|
|
break;
|
|
|
|
case 0x1c: /* TIER */
|
|
s->it_ena = value & 7;
|
|
break;
|
|
|
|
case 0x20: /* TWER */
|
|
s->wu_ena = value & 7;
|
|
break;
|
|
|
|
case 0x24: /* TCLR */
|
|
omap_gp_timer_sync(s);
|
|
s->inout = (value >> 14) & 1;
|
|
s->capt2 = (value >> 13) & 1;
|
|
s->pt = (value >> 12) & 1;
|
|
s->trigger = (value >> 10) & 3;
|
|
if (s->capture == gpt_capture_none &&
|
|
((value >> 8) & 3) != gpt_capture_none)
|
|
s->capt_num = 0;
|
|
s->capture = (value >> 8) & 3;
|
|
s->scpwm = (value >> 7) & 1;
|
|
s->ce = (value >> 6) & 1;
|
|
s->pre = (value >> 5) & 1;
|
|
s->ptv = (value >> 2) & 7;
|
|
s->ar = (value >> 1) & 1;
|
|
s->st = (value >> 0) & 1;
|
|
if (s->inout && s->trigger != gpt_trigger_none)
|
|
fprintf(stderr, "%s: GP timer pin must be an output "
|
|
"for this trigger mode\n", __FUNCTION__);
|
|
if (!s->inout && s->capture != gpt_capture_none)
|
|
fprintf(stderr, "%s: GP timer pin must be an input "
|
|
"for this capture mode\n", __FUNCTION__);
|
|
if (s->trigger == gpt_trigger_none)
|
|
omap_gp_timer_out(s, s->scpwm);
|
|
/* TODO: make sure this doesn't overflow 32-bits */
|
|
s->ticks_per_sec = ticks_per_sec << (s->pre ? s->ptv + 1 : 0);
|
|
omap_gp_timer_update(s);
|
|
break;
|
|
|
|
case 0x28: /* TCRR */
|
|
s->time = qemu_get_clock(vm_clock);
|
|
s->val = value;
|
|
omap_gp_timer_update(s);
|
|
break;
|
|
|
|
case 0x2c: /* TLDR */
|
|
s->load_val = value;
|
|
break;
|
|
|
|
case 0x30: /* TTGR */
|
|
s->time = qemu_get_clock(vm_clock);
|
|
s->val = s->load_val;
|
|
omap_gp_timer_update(s);
|
|
break;
|
|
|
|
case 0x38: /* TMAR */
|
|
omap_gp_timer_sync(s);
|
|
s->match_val = value;
|
|
omap_gp_timer_update(s);
|
|
break;
|
|
|
|
case 0x40: /* TSICR */
|
|
s->posted = (value >> 2) & 1;
|
|
if (value & 2) /* How much exactly are we supposed to reset? */
|
|
omap_gp_timer_reset(s);
|
|
break;
|
|
|
|
default:
|
|
OMAP_BAD_REG(addr);
|
|
}
|
|
}
|
|
|
|
static void omap_gp_timer_writeh(void *opaque, target_phys_addr_t addr,
|
|
uint32_t value)
|
|
{
|
|
struct omap_gp_timer_s *s = (struct omap_gp_timer_s *) opaque;
|
|
|
|
if (addr & 2)
|
|
return omap_gp_timer_write(opaque, addr, (value << 16) | s->writeh);
|
|
else
|
|
s->writeh = (uint16_t) value;
|
|
}
|
|
|
|
static CPUWriteMemoryFunc *omap_gp_timer_writefn[] = {
|
|
omap_badwidth_write32,
|
|
omap_gp_timer_writeh,
|
|
omap_gp_timer_write,
|
|
};
|
|
|
|
struct omap_gp_timer_s *omap_gp_timer_init(struct omap_target_agent_s *ta,
|
|
qemu_irq irq, omap_clk fclk, omap_clk iclk)
|
|
{
|
|
int iomemtype;
|
|
struct omap_gp_timer_s *s = (struct omap_gp_timer_s *)
|
|
qemu_mallocz(sizeof(struct omap_gp_timer_s));
|
|
|
|
s->ta = ta;
|
|
s->irq = irq;
|
|
s->clk = fclk;
|
|
s->timer = qemu_new_timer(vm_clock, omap_gp_timer_tick, s);
|
|
s->match = qemu_new_timer(vm_clock, omap_gp_timer_match, s);
|
|
s->in = qemu_allocate_irqs(omap_gp_timer_input, s, 1)[0];
|
|
omap_gp_timer_reset(s);
|
|
omap_gp_timer_clk_setup(s);
|
|
|
|
iomemtype = l4_register_io_memory(0, omap_gp_timer_readfn,
|
|
omap_gp_timer_writefn, s);
|
|
s->base = omap_l4_attach(ta, 0, iomemtype);
|
|
|
|
return s;
|
|
}
|
|
|
|
/* 32-kHz Sync Timer of the OMAP2 */
|
|
static uint32_t omap_synctimer_read(struct omap_synctimer_s *s) {
|
|
return muldiv64(qemu_get_clock(vm_clock), 0x8000, ticks_per_sec);
|
|
}
|
|
|
|
static void omap_synctimer_reset(struct omap_synctimer_s *s)
|
|
{
|
|
s->val = omap_synctimer_read(s);
|
|
}
|
|
|
|
static uint32_t omap_synctimer_readw(void *opaque, target_phys_addr_t addr)
|
|
{
|
|
struct omap_synctimer_s *s = (struct omap_synctimer_s *) opaque;
|
|
int offset = addr - s->base;
|
|
|
|
switch (offset) {
|
|
case 0x00: /* 32KSYNCNT_REV */
|
|
return 0x21;
|
|
|
|
case 0x10: /* CR */
|
|
return omap_synctimer_read(s) - s->val;
|
|
}
|
|
|
|
OMAP_BAD_REG(addr);
|
|
return 0;
|
|
}
|
|
|
|
static uint32_t omap_synctimer_readh(void *opaque, target_phys_addr_t addr)
|
|
{
|
|
struct omap_synctimer_s *s = (struct omap_synctimer_s *) opaque;
|
|
uint32_t ret;
|
|
|
|
if (addr & 2)
|
|
return s->readh;
|
|
else {
|
|
ret = omap_synctimer_readw(opaque, addr);
|
|
s->readh = ret >> 16;
|
|
return ret & 0xffff;
|
|
}
|
|
}
|
|
|
|
static CPUReadMemoryFunc *omap_synctimer_readfn[] = {
|
|
omap_badwidth_read32,
|
|
omap_synctimer_readh,
|
|
omap_synctimer_readw,
|
|
};
|
|
|
|
static void omap_synctimer_write(void *opaque, target_phys_addr_t addr,
|
|
uint32_t value)
|
|
{
|
|
OMAP_BAD_REG(addr);
|
|
}
|
|
|
|
static CPUWriteMemoryFunc *omap_synctimer_writefn[] = {
|
|
omap_badwidth_write32,
|
|
omap_synctimer_write,
|
|
omap_synctimer_write,
|
|
};
|
|
|
|
void omap_synctimer_init(struct omap_target_agent_s *ta,
|
|
struct omap_mpu_state_s *mpu, omap_clk fclk, omap_clk iclk)
|
|
{
|
|
struct omap_synctimer_s *s = &mpu->synctimer;
|
|
|
|
omap_synctimer_reset(s);
|
|
s->base = omap_l4_attach(ta, 0, l4_register_io_memory(0,
|
|
omap_synctimer_readfn, omap_synctimer_writefn, s));
|
|
}
|
|
|
|
/* General-Purpose Interface of OMAP2 */
|
|
struct omap2_gpio_s {
|
|
target_phys_addr_t base;
|
|
qemu_irq irq[2];
|
|
qemu_irq wkup;
|
|
qemu_irq *in;
|
|
qemu_irq handler[32];
|
|
|
|
uint8_t config[2];
|
|
uint32_t inputs;
|
|
uint32_t outputs;
|
|
uint32_t dir;
|
|
uint32_t level[2];
|
|
uint32_t edge[2];
|
|
uint32_t mask[2];
|
|
uint32_t wumask;
|
|
uint32_t ints[2];
|
|
uint32_t debounce;
|
|
uint8_t delay;
|
|
};
|
|
|
|
static inline void omap_gpio_module_int_update(struct omap2_gpio_s *s,
|
|
int line)
|
|
{
|
|
qemu_set_irq(s->irq[line], s->ints[line] & s->mask[line]);
|
|
}
|
|
|
|
static void omap_gpio_module_wake(struct omap2_gpio_s *s, int line)
|
|
{
|
|
if (!(s->config[0] & (1 << 2))) /* ENAWAKEUP */
|
|
return;
|
|
if (!(s->config[0] & (3 << 3))) /* Force Idle */
|
|
return;
|
|
if (!(s->wumask & (1 << line)))
|
|
return;
|
|
|
|
qemu_irq_raise(s->wkup);
|
|
}
|
|
|
|
static inline void omap_gpio_module_out_update(struct omap2_gpio_s *s,
|
|
uint32_t diff)
|
|
{
|
|
int ln;
|
|
|
|
s->outputs ^= diff;
|
|
diff &= ~s->dir;
|
|
while ((ln = ffs(diff))) {
|
|
ln --;
|
|
qemu_set_irq(s->handler[ln], (s->outputs >> ln) & 1);
|
|
diff &= ~(1 << ln);
|
|
}
|
|
}
|
|
|
|
static void omap_gpio_module_level_update(struct omap2_gpio_s *s, int line)
|
|
{
|
|
s->ints[line] |= s->dir &
|
|
((s->inputs & s->level[1]) | (~s->inputs & s->level[0]));
|
|
omap_gpio_module_int_update(s, line);
|
|
}
|
|
|
|
static inline void omap_gpio_module_int(struct omap2_gpio_s *s, int line)
|
|
{
|
|
s->ints[0] |= 1 << line;
|
|
omap_gpio_module_int_update(s, 0);
|
|
s->ints[1] |= 1 << line;
|
|
omap_gpio_module_int_update(s, 1);
|
|
omap_gpio_module_wake(s, line);
|
|
}
|
|
|
|
static void omap_gpio_module_set(void *opaque, int line, int level)
|
|
{
|
|
struct omap2_gpio_s *s = (struct omap2_gpio_s *) opaque;
|
|
|
|
if (level) {
|
|
if (s->dir & (1 << line) & ((~s->inputs & s->edge[0]) | s->level[1]))
|
|
omap_gpio_module_int(s, line);
|
|
s->inputs |= 1 << line;
|
|
} else {
|
|
if (s->dir & (1 << line) & ((s->inputs & s->edge[1]) | s->level[0]))
|
|
omap_gpio_module_int(s, line);
|
|
s->inputs &= ~(1 << line);
|
|
}
|
|
}
|
|
|
|
static void omap_gpio_module_reset(struct omap2_gpio_s *s)
|
|
{
|
|
s->config[0] = 0;
|
|
s->config[1] = 2;
|
|
s->ints[0] = 0;
|
|
s->ints[1] = 0;
|
|
s->mask[0] = 0;
|
|
s->mask[1] = 0;
|
|
s->wumask = 0;
|
|
s->dir = ~0;
|
|
s->level[0] = 0;
|
|
s->level[1] = 0;
|
|
s->edge[0] = 0;
|
|
s->edge[1] = 0;
|
|
s->debounce = 0;
|
|
s->delay = 0;
|
|
}
|
|
|
|
static uint32_t omap_gpio_module_read(void *opaque, target_phys_addr_t addr)
|
|
{
|
|
struct omap2_gpio_s *s = (struct omap2_gpio_s *) opaque;
|
|
int offset = addr - s->base;
|
|
|
|
switch (offset) {
|
|
case 0x00: /* GPIO_REVISION */
|
|
return 0x18;
|
|
|
|
case 0x10: /* GPIO_SYSCONFIG */
|
|
return s->config[0];
|
|
|
|
case 0x14: /* GPIO_SYSSTATUS */
|
|
return 0x01;
|
|
|
|
case 0x18: /* GPIO_IRQSTATUS1 */
|
|
return s->ints[0];
|
|
|
|
case 0x1c: /* GPIO_IRQENABLE1 */
|
|
case 0x60: /* GPIO_CLEARIRQENABLE1 */
|
|
case 0x64: /* GPIO_SETIRQENABLE1 */
|
|
return s->mask[0];
|
|
|
|
case 0x20: /* GPIO_WAKEUPENABLE */
|
|
case 0x80: /* GPIO_CLEARWKUENA */
|
|
case 0x84: /* GPIO_SETWKUENA */
|
|
return s->wumask;
|
|
|
|
case 0x28: /* GPIO_IRQSTATUS2 */
|
|
return s->ints[1];
|
|
|
|
case 0x2c: /* GPIO_IRQENABLE2 */
|
|
case 0x70: /* GPIO_CLEARIRQENABLE2 */
|
|
case 0x74: /* GPIO_SETIREQNEABLE2 */
|
|
return s->mask[1];
|
|
|
|
case 0x30: /* GPIO_CTRL */
|
|
return s->config[1];
|
|
|
|
case 0x34: /* GPIO_OE */
|
|
return s->dir;
|
|
|
|
case 0x38: /* GPIO_DATAIN */
|
|
return s->inputs;
|
|
|
|
case 0x3c: /* GPIO_DATAOUT */
|
|
case 0x90: /* GPIO_CLEARDATAOUT */
|
|
case 0x94: /* GPIO_SETDATAOUT */
|
|
return s->outputs;
|
|
|
|
case 0x40: /* GPIO_LEVELDETECT0 */
|
|
return s->level[0];
|
|
|
|
case 0x44: /* GPIO_LEVELDETECT1 */
|
|
return s->level[1];
|
|
|
|
case 0x48: /* GPIO_RISINGDETECT */
|
|
return s->edge[0];
|
|
|
|
case 0x4c: /* GPIO_FALLINGDETECT */
|
|
return s->edge[1];
|
|
|
|
case 0x50: /* GPIO_DEBOUNCENABLE */
|
|
return s->debounce;
|
|
|
|
case 0x54: /* GPIO_DEBOUNCINGTIME */
|
|
return s->delay;
|
|
}
|
|
|
|
OMAP_BAD_REG(addr);
|
|
return 0;
|
|
}
|
|
|
|
static void omap_gpio_module_write(void *opaque, target_phys_addr_t addr,
|
|
uint32_t value)
|
|
{
|
|
struct omap2_gpio_s *s = (struct omap2_gpio_s *) opaque;
|
|
int offset = addr - s->base;
|
|
uint32_t diff;
|
|
int ln;
|
|
|
|
switch (offset) {
|
|
case 0x00: /* GPIO_REVISION */
|
|
case 0x14: /* GPIO_SYSSTATUS */
|
|
case 0x38: /* GPIO_DATAIN */
|
|
OMAP_RO_REG(addr);
|
|
break;
|
|
|
|
case 0x10: /* GPIO_SYSCONFIG */
|
|
if (((value >> 3) & 3) == 3)
|
|
fprintf(stderr, "%s: bad IDLEMODE value\n", __FUNCTION__);
|
|
if (value & 2)
|
|
omap_gpio_module_reset(s);
|
|
s->config[0] = value & 0x1d;
|
|
break;
|
|
|
|
case 0x18: /* GPIO_IRQSTATUS1 */
|
|
if (s->ints[0] & value) {
|
|
s->ints[0] &= ~value;
|
|
omap_gpio_module_level_update(s, 0);
|
|
}
|
|
break;
|
|
|
|
case 0x1c: /* GPIO_IRQENABLE1 */
|
|
s->mask[0] = value;
|
|
omap_gpio_module_int_update(s, 0);
|
|
break;
|
|
|
|
case 0x20: /* GPIO_WAKEUPENABLE */
|
|
s->wumask = value;
|
|
break;
|
|
|
|
case 0x28: /* GPIO_IRQSTATUS2 */
|
|
if (s->ints[1] & value) {
|
|
s->ints[1] &= ~value;
|
|
omap_gpio_module_level_update(s, 1);
|
|
}
|
|
break;
|
|
|
|
case 0x2c: /* GPIO_IRQENABLE2 */
|
|
s->mask[1] = value;
|
|
omap_gpio_module_int_update(s, 1);
|
|
break;
|
|
|
|
case 0x30: /* GPIO_CTRL */
|
|
s->config[1] = value & 7;
|
|
break;
|
|
|
|
case 0x34: /* GPIO_OE */
|
|
diff = s->outputs & (s->dir ^ value);
|
|
s->dir = value;
|
|
|
|
value = s->outputs & ~s->dir;
|
|
while ((ln = ffs(diff))) {
|
|
diff &= ~(1 <<-- ln);
|
|
qemu_set_irq(s->handler[ln], (value >> ln) & 1);
|
|
}
|
|
|
|
omap_gpio_module_level_update(s, 0);
|
|
omap_gpio_module_level_update(s, 1);
|
|
break;
|
|
|
|
case 0x3c: /* GPIO_DATAOUT */
|
|
omap_gpio_module_out_update(s, s->outputs ^ value);
|
|
break;
|
|
|
|
case 0x40: /* GPIO_LEVELDETECT0 */
|
|
s->level[0] = value;
|
|
omap_gpio_module_level_update(s, 0);
|
|
omap_gpio_module_level_update(s, 1);
|
|
break;
|
|
|
|
case 0x44: /* GPIO_LEVELDETECT1 */
|
|
s->level[1] = value;
|
|
omap_gpio_module_level_update(s, 0);
|
|
omap_gpio_module_level_update(s, 1);
|
|
break;
|
|
|
|
case 0x48: /* GPIO_RISINGDETECT */
|
|
s->edge[0] = value;
|
|
break;
|
|
|
|
case 0x4c: /* GPIO_FALLINGDETECT */
|
|
s->edge[1] = value;
|
|
break;
|
|
|
|
case 0x50: /* GPIO_DEBOUNCENABLE */
|
|
s->debounce = value;
|
|
break;
|
|
|
|
case 0x54: /* GPIO_DEBOUNCINGTIME */
|
|
s->delay = value;
|
|
break;
|
|
|
|
case 0x60: /* GPIO_CLEARIRQENABLE1 */
|
|
s->mask[0] &= ~value;
|
|
omap_gpio_module_int_update(s, 0);
|
|
break;
|
|
|
|
case 0x64: /* GPIO_SETIRQENABLE1 */
|
|
s->mask[0] |= value;
|
|
omap_gpio_module_int_update(s, 0);
|
|
break;
|
|
|
|
case 0x70: /* GPIO_CLEARIRQENABLE2 */
|
|
s->mask[1] &= ~value;
|
|
omap_gpio_module_int_update(s, 1);
|
|
break;
|
|
|
|
case 0x74: /* GPIO_SETIREQNEABLE2 */
|
|
s->mask[1] |= value;
|
|
omap_gpio_module_int_update(s, 1);
|
|
break;
|
|
|
|
case 0x80: /* GPIO_CLEARWKUENA */
|
|
s->wumask &= ~value;
|
|
break;
|
|
|
|
case 0x84: /* GPIO_SETWKUENA */
|
|
s->wumask |= value;
|
|
break;
|
|
|
|
case 0x90: /* GPIO_CLEARDATAOUT */
|
|
omap_gpio_module_out_update(s, s->outputs & value);
|
|
break;
|
|
|
|
case 0x94: /* GPIO_SETDATAOUT */
|
|
omap_gpio_module_out_update(s, ~s->outputs & value);
|
|
break;
|
|
|
|
default:
|
|
OMAP_BAD_REG(addr);
|
|
return;
|
|
}
|
|
}
|
|
|
|
static uint32_t omap_gpio_module_readp(void *opaque, target_phys_addr_t addr)
|
|
{
|
|
return omap_gpio_module_readp(opaque, addr) >> ((addr & 3) << 3);
|
|
}
|
|
|
|
static void omap_gpio_module_writep(void *opaque, target_phys_addr_t addr,
|
|
uint32_t value)
|
|
{
|
|
struct omap2_gpio_s *s = (struct omap2_gpio_s *) opaque;
|
|
int offset = addr - s->base;
|
|
uint32_t cur = 0;
|
|
uint32_t mask = 0xffff;
|
|
|
|
switch (offset & ~3) {
|
|
case 0x00: /* GPIO_REVISION */
|
|
case 0x14: /* GPIO_SYSSTATUS */
|
|
case 0x38: /* GPIO_DATAIN */
|
|
OMAP_RO_REG(addr);
|
|
break;
|
|
|
|
case 0x10: /* GPIO_SYSCONFIG */
|
|
case 0x1c: /* GPIO_IRQENABLE1 */
|
|
case 0x20: /* GPIO_WAKEUPENABLE */
|
|
case 0x2c: /* GPIO_IRQENABLE2 */
|
|
case 0x30: /* GPIO_CTRL */
|
|
case 0x34: /* GPIO_OE */
|
|
case 0x3c: /* GPIO_DATAOUT */
|
|
case 0x40: /* GPIO_LEVELDETECT0 */
|
|
case 0x44: /* GPIO_LEVELDETECT1 */
|
|
case 0x48: /* GPIO_RISINGDETECT */
|
|
case 0x4c: /* GPIO_FALLINGDETECT */
|
|
case 0x50: /* GPIO_DEBOUNCENABLE */
|
|
case 0x54: /* GPIO_DEBOUNCINGTIME */
|
|
cur = omap_gpio_module_read(opaque, addr & ~3) &
|
|
~(mask << ((addr & 3) << 3));
|
|
|
|
/* Fall through. */
|
|
case 0x18: /* GPIO_IRQSTATUS1 */
|
|
case 0x28: /* GPIO_IRQSTATUS2 */
|
|
case 0x60: /* GPIO_CLEARIRQENABLE1 */
|
|
case 0x64: /* GPIO_SETIRQENABLE1 */
|
|
case 0x70: /* GPIO_CLEARIRQENABLE2 */
|
|
case 0x74: /* GPIO_SETIREQNEABLE2 */
|
|
case 0x80: /* GPIO_CLEARWKUENA */
|
|
case 0x84: /* GPIO_SETWKUENA */
|
|
case 0x90: /* GPIO_CLEARDATAOUT */
|
|
case 0x94: /* GPIO_SETDATAOUT */
|
|
value <<= (addr & 3) << 3;
|
|
omap_gpio_module_write(opaque, addr, cur | value);
|
|
break;
|
|
|
|
default:
|
|
OMAP_BAD_REG(addr);
|
|
return;
|
|
}
|
|
}
|
|
|
|
static CPUReadMemoryFunc *omap_gpio_module_readfn[] = {
|
|
omap_gpio_module_readp,
|
|
omap_gpio_module_readp,
|
|
omap_gpio_module_read,
|
|
};
|
|
|
|
static CPUWriteMemoryFunc *omap_gpio_module_writefn[] = {
|
|
omap_gpio_module_writep,
|
|
omap_gpio_module_writep,
|
|
omap_gpio_module_write,
|
|
};
|
|
|
|
static void omap_gpio_module_init(struct omap2_gpio_s *s,
|
|
struct omap_target_agent_s *ta, int region,
|
|
qemu_irq mpu, qemu_irq dsp, qemu_irq wkup,
|
|
omap_clk fclk, omap_clk iclk)
|
|
{
|
|
int iomemtype;
|
|
|
|
s->irq[0] = mpu;
|
|
s->irq[1] = dsp;
|
|
s->wkup = wkup;
|
|
s->in = qemu_allocate_irqs(omap_gpio_module_set, s, 32);
|
|
|
|
iomemtype = l4_register_io_memory(0, omap_gpio_module_readfn,
|
|
omap_gpio_module_writefn, s);
|
|
s->base = omap_l4_attach(ta, region, iomemtype);
|
|
}
|
|
|
|
struct omap_gpif_s {
|
|
struct omap2_gpio_s module[5];
|
|
int modules;
|
|
|
|
target_phys_addr_t topbase;
|
|
int autoidle;
|
|
int gpo;
|
|
};
|
|
|
|
static void omap_gpif_reset(struct omap_gpif_s *s)
|
|
{
|
|
int i;
|
|
|
|
for (i = 0; i < s->modules; i ++)
|
|
omap_gpio_module_reset(s->module + i);
|
|
|
|
s->autoidle = 0;
|
|
s->gpo = 0;
|
|
}
|
|
|
|
static uint32_t omap_gpif_top_read(void *opaque, target_phys_addr_t addr)
|
|
{
|
|
struct omap_gpif_s *s = (struct omap_gpif_s *) opaque;
|
|
int offset = addr - s->topbase;
|
|
|
|
switch (offset) {
|
|
case 0x00: /* IPGENERICOCPSPL_REVISION */
|
|
return 0x18;
|
|
|
|
case 0x10: /* IPGENERICOCPSPL_SYSCONFIG */
|
|
return s->autoidle;
|
|
|
|
case 0x14: /* IPGENERICOCPSPL_SYSSTATUS */
|
|
return 0x01;
|
|
|
|
case 0x18: /* IPGENERICOCPSPL_IRQSTATUS */
|
|
return 0x00;
|
|
|
|
case 0x40: /* IPGENERICOCPSPL_GPO */
|
|
return s->gpo;
|
|
|
|
case 0x50: /* IPGENERICOCPSPL_GPI */
|
|
return 0x00;
|
|
}
|
|
|
|
OMAP_BAD_REG(addr);
|
|
return 0;
|
|
}
|
|
|
|
static void omap_gpif_top_write(void *opaque, target_phys_addr_t addr,
|
|
uint32_t value)
|
|
{
|
|
struct omap_gpif_s *s = (struct omap_gpif_s *) opaque;
|
|
int offset = addr - s->topbase;
|
|
|
|
switch (offset) {
|
|
case 0x00: /* IPGENERICOCPSPL_REVISION */
|
|
case 0x14: /* IPGENERICOCPSPL_SYSSTATUS */
|
|
case 0x18: /* IPGENERICOCPSPL_IRQSTATUS */
|
|
case 0x50: /* IPGENERICOCPSPL_GPI */
|
|
OMAP_RO_REG(addr);
|
|
break;
|
|
|
|
case 0x10: /* IPGENERICOCPSPL_SYSCONFIG */
|
|
if (value & (1 << 1)) /* SOFTRESET */
|
|
omap_gpif_reset(s);
|
|
s->autoidle = value & 1;
|
|
break;
|
|
|
|
case 0x40: /* IPGENERICOCPSPL_GPO */
|
|
s->gpo = value & 1;
|
|
break;
|
|
|
|
default:
|
|
OMAP_BAD_REG(addr);
|
|
return;
|
|
}
|
|
}
|
|
|
|
static CPUReadMemoryFunc *omap_gpif_top_readfn[] = {
|
|
omap_gpif_top_read,
|
|
omap_gpif_top_read,
|
|
omap_gpif_top_read,
|
|
};
|
|
|
|
static CPUWriteMemoryFunc *omap_gpif_top_writefn[] = {
|
|
omap_gpif_top_write,
|
|
omap_gpif_top_write,
|
|
omap_gpif_top_write,
|
|
};
|
|
|
|
struct omap_gpif_s *omap2_gpio_init(struct omap_target_agent_s *ta,
|
|
qemu_irq *irq, omap_clk *fclk, omap_clk iclk, int modules)
|
|
{
|
|
int iomemtype, i;
|
|
struct omap_gpif_s *s = (struct omap_gpif_s *)
|
|
qemu_mallocz(sizeof(struct omap_gpif_s));
|
|
int region[4] = { 0, 2, 4, 5 };
|
|
|
|
s->modules = modules;
|
|
for (i = 0; i < modules; i ++)
|
|
omap_gpio_module_init(s->module + i, ta, region[i],
|
|
irq[i], 0, 0, fclk[i], iclk);
|
|
|
|
omap_gpif_reset(s);
|
|
|
|
iomemtype = l4_register_io_memory(0, omap_gpif_top_readfn,
|
|
omap_gpif_top_writefn, s);
|
|
s->topbase = omap_l4_attach(ta, 1, iomemtype);
|
|
|
|
return s;
|
|
}
|
|
|
|
qemu_irq *omap2_gpio_in_get(struct omap_gpif_s *s, int start)
|
|
{
|
|
if (start >= s->modules * 32 || start < 0)
|
|
cpu_abort(cpu_single_env, "%s: No GPIO line %i\n",
|
|
__FUNCTION__, start);
|
|
return s->module[start >> 5].in + (start & 31);
|
|
}
|
|
|
|
void omap2_gpio_out_set(struct omap_gpif_s *s, int line, qemu_irq handler)
|
|
{
|
|
if (line >= s->modules * 32 || line < 0)
|
|
cpu_abort(cpu_single_env, "%s: No GPIO line %i\n", __FUNCTION__, line);
|
|
s->module[line >> 5].handler[line & 31] = handler;
|
|
}
|
|
|
|
/* Multichannel SPI */
|
|
struct omap_mcspi_s {
|
|
target_phys_addr_t base;
|
|
qemu_irq irq;
|
|
int chnum;
|
|
|
|
uint32_t sysconfig;
|
|
uint32_t systest;
|
|
uint32_t irqst;
|
|
uint32_t irqen;
|
|
uint32_t wken;
|
|
uint32_t control;
|
|
|
|
struct omap_mcspi_ch_s {
|
|
qemu_irq txdrq;
|
|
qemu_irq rxdrq;
|
|
uint32_t (*txrx)(void *opaque, uint32_t, int);
|
|
void *opaque;
|
|
|
|
uint32_t tx;
|
|
uint32_t rx;
|
|
|
|
uint32_t config;
|
|
uint32_t status;
|
|
uint32_t control;
|
|
} ch[4];
|
|
};
|
|
|
|
static inline void omap_mcspi_interrupt_update(struct omap_mcspi_s *s)
|
|
{
|
|
qemu_set_irq(s->irq, s->irqst & s->irqen);
|
|
}
|
|
|
|
static inline void omap_mcspi_dmarequest_update(struct omap_mcspi_ch_s *ch)
|
|
{
|
|
qemu_set_irq(ch->txdrq,
|
|
(ch->control & 1) && /* EN */
|
|
(ch->config & (1 << 14)) && /* DMAW */
|
|
(ch->status & (1 << 1)) && /* TXS */
|
|
((ch->config >> 12) & 3) != 1); /* TRM */
|
|
qemu_set_irq(ch->rxdrq,
|
|
(ch->control & 1) && /* EN */
|
|
(ch->config & (1 << 15)) && /* DMAW */
|
|
(ch->status & (1 << 0)) && /* RXS */
|
|
((ch->config >> 12) & 3) != 2); /* TRM */
|
|
}
|
|
|
|
static void omap_mcspi_transfer_run(struct omap_mcspi_s *s, int chnum)
|
|
{
|
|
struct omap_mcspi_ch_s *ch = s->ch + chnum;
|
|
|
|
if (!(ch->control & 1)) /* EN */
|
|
return;
|
|
if ((ch->status & (1 << 0)) && /* RXS */
|
|
((ch->config >> 12) & 3) != 2 && /* TRM */
|
|
!(ch->config & (1 << 19))) /* TURBO */
|
|
goto intr_update;
|
|
if ((ch->status & (1 << 1)) && /* TXS */
|
|
((ch->config >> 12) & 3) != 1) /* TRM */
|
|
goto intr_update;
|
|
|
|
if (!(s->control & 1) || /* SINGLE */
|
|
(ch->config & (1 << 20))) { /* FORCE */
|
|
if (ch->txrx)
|
|
ch->rx = ch->txrx(ch->opaque, ch->tx, /* WL */
|
|
1 + (0x1f & (ch->config >> 7)));
|
|
}
|
|
|
|
ch->tx = 0;
|
|
ch->status |= 1 << 2; /* EOT */
|
|
ch->status |= 1 << 1; /* TXS */
|
|
if (((ch->config >> 12) & 3) != 2) /* TRM */
|
|
ch->status |= 1 << 0; /* RXS */
|
|
|
|
intr_update:
|
|
if ((ch->status & (1 << 0)) && /* RXS */
|
|
((ch->config >> 12) & 3) != 2 && /* TRM */
|
|
!(ch->config & (1 << 19))) /* TURBO */
|
|
s->irqst |= 1 << (2 + 4 * chnum); /* RX_FULL */
|
|
if ((ch->status & (1 << 1)) && /* TXS */
|
|
((ch->config >> 12) & 3) != 1) /* TRM */
|
|
s->irqst |= 1 << (0 + 4 * chnum); /* TX_EMPTY */
|
|
omap_mcspi_interrupt_update(s);
|
|
omap_mcspi_dmarequest_update(ch);
|
|
}
|
|
|
|
static void omap_mcspi_reset(struct omap_mcspi_s *s)
|
|
{
|
|
int ch;
|
|
|
|
s->sysconfig = 0;
|
|
s->systest = 0;
|
|
s->irqst = 0;
|
|
s->irqen = 0;
|
|
s->wken = 0;
|
|
s->control = 4;
|
|
|
|
for (ch = 0; ch < 4; ch ++) {
|
|
s->ch[ch].config = 0x060000;
|
|
s->ch[ch].status = 2; /* TXS */
|
|
s->ch[ch].control = 0;
|
|
|
|
omap_mcspi_dmarequest_update(s->ch + ch);
|
|
}
|
|
|
|
omap_mcspi_interrupt_update(s);
|
|
}
|
|
|
|
static uint32_t omap_mcspi_read(void *opaque, target_phys_addr_t addr)
|
|
{
|
|
struct omap_mcspi_s *s = (struct omap_mcspi_s *) opaque;
|
|
int offset = addr - s->base;
|
|
int ch = 0;
|
|
uint32_t ret;
|
|
|
|
switch (offset) {
|
|
case 0x00: /* MCSPI_REVISION */
|
|
return 0x91;
|
|
|
|
case 0x10: /* MCSPI_SYSCONFIG */
|
|
return s->sysconfig;
|
|
|
|
case 0x14: /* MCSPI_SYSSTATUS */
|
|
return 1; /* RESETDONE */
|
|
|
|
case 0x18: /* MCSPI_IRQSTATUS */
|
|
return s->irqst;
|
|
|
|
case 0x1c: /* MCSPI_IRQENABLE */
|
|
return s->irqen;
|
|
|
|
case 0x20: /* MCSPI_WAKEUPENABLE */
|
|
return s->wken;
|
|
|
|
case 0x24: /* MCSPI_SYST */
|
|
return s->systest;
|
|
|
|
case 0x28: /* MCSPI_MODULCTRL */
|
|
return s->control;
|
|
|
|
case 0x68: ch ++;
|
|
case 0x54: ch ++;
|
|
case 0x40: ch ++;
|
|
case 0x2c: /* MCSPI_CHCONF */
|
|
return s->ch[ch].config;
|
|
|
|
case 0x6c: ch ++;
|
|
case 0x58: ch ++;
|
|
case 0x44: ch ++;
|
|
case 0x30: /* MCSPI_CHSTAT */
|
|
return s->ch[ch].status;
|
|
|
|
case 0x70: ch ++;
|
|
case 0x5c: ch ++;
|
|
case 0x48: ch ++;
|
|
case 0x34: /* MCSPI_CHCTRL */
|
|
return s->ch[ch].control;
|
|
|
|
case 0x74: ch ++;
|
|
case 0x60: ch ++;
|
|
case 0x4c: ch ++;
|
|
case 0x38: /* MCSPI_TX */
|
|
return s->ch[ch].tx;
|
|
|
|
case 0x78: ch ++;
|
|
case 0x64: ch ++;
|
|
case 0x50: ch ++;
|
|
case 0x3c: /* MCSPI_RX */
|
|
s->ch[ch].status &= ~(1 << 0); /* RXS */
|
|
ret = s->ch[ch].rx;
|
|
omap_mcspi_transfer_run(s, ch);
|
|
return ret;
|
|
}
|
|
|
|
OMAP_BAD_REG(addr);
|
|
return 0;
|
|
}
|
|
|
|
static void omap_mcspi_write(void *opaque, target_phys_addr_t addr,
|
|
uint32_t value)
|
|
{
|
|
struct omap_mcspi_s *s = (struct omap_mcspi_s *) opaque;
|
|
int offset = addr - s->base;
|
|
int ch = 0;
|
|
|
|
switch (offset) {
|
|
case 0x00: /* MCSPI_REVISION */
|
|
case 0x14: /* MCSPI_SYSSTATUS */
|
|
case 0x30: /* MCSPI_CHSTAT0 */
|
|
case 0x3c: /* MCSPI_RX0 */
|
|
case 0x44: /* MCSPI_CHSTAT1 */
|
|
case 0x50: /* MCSPI_RX1 */
|
|
case 0x58: /* MCSPI_CHSTAT2 */
|
|
case 0x64: /* MCSPI_RX2 */
|
|
case 0x6c: /* MCSPI_CHSTAT3 */
|
|
case 0x78: /* MCSPI_RX3 */
|
|
OMAP_RO_REG(addr);
|
|
return;
|
|
|
|
case 0x10: /* MCSPI_SYSCONFIG */
|
|
if (value & (1 << 1)) /* SOFTRESET */
|
|
omap_mcspi_reset(s);
|
|
s->sysconfig = value & 0x31d;
|
|
break;
|
|
|
|
case 0x18: /* MCSPI_IRQSTATUS */
|
|
if (!((s->control & (1 << 3)) && (s->systest & (1 << 11)))) {
|
|
s->irqst &= ~value;
|
|
omap_mcspi_interrupt_update(s);
|
|
}
|
|
break;
|
|
|
|
case 0x1c: /* MCSPI_IRQENABLE */
|
|
s->irqen = value & 0x1777f;
|
|
omap_mcspi_interrupt_update(s);
|
|
break;
|
|
|
|
case 0x20: /* MCSPI_WAKEUPENABLE */
|
|
s->wken = value & 1;
|
|
break;
|
|
|
|
case 0x24: /* MCSPI_SYST */
|
|
if (s->control & (1 << 3)) /* SYSTEM_TEST */
|
|
if (value & (1 << 11)) { /* SSB */
|
|
s->irqst |= 0x1777f;
|
|
omap_mcspi_interrupt_update(s);
|
|
}
|
|
s->systest = value & 0xfff;
|
|
break;
|
|
|
|
case 0x28: /* MCSPI_MODULCTRL */
|
|
if (value & (1 << 3)) /* SYSTEM_TEST */
|
|
if (s->systest & (1 << 11)) { /* SSB */
|
|
s->irqst |= 0x1777f;
|
|
omap_mcspi_interrupt_update(s);
|
|
}
|
|
s->control = value & 0xf;
|
|
break;
|
|
|
|
case 0x68: ch ++;
|
|
case 0x54: ch ++;
|
|
case 0x40: ch ++;
|
|
case 0x2c: /* MCSPI_CHCONF */
|
|
if ((value ^ s->ch[ch].config) & (3 << 14)) /* DMAR | DMAW */
|
|
omap_mcspi_dmarequest_update(s->ch + ch);
|
|
if (((value >> 12) & 3) == 3) /* TRM */
|
|
fprintf(stderr, "%s: invalid TRM value (3)\n", __FUNCTION__);
|
|
if (((value >> 7) & 0x1f) < 3) /* WL */
|
|
fprintf(stderr, "%s: invalid WL value (%i)\n",
|
|
__FUNCTION__, (value >> 7) & 0x1f);
|
|
s->ch[ch].config = value & 0x7fffff;
|
|
break;
|
|
|
|
case 0x70: ch ++;
|
|
case 0x5c: ch ++;
|
|
case 0x48: ch ++;
|
|
case 0x34: /* MCSPI_CHCTRL */
|
|
if (value & ~s->ch[ch].control & 1) { /* EN */
|
|
s->ch[ch].control |= 1;
|
|
omap_mcspi_transfer_run(s, ch);
|
|
} else
|
|
s->ch[ch].control = value & 1;
|
|
break;
|
|
|
|
case 0x74: ch ++;
|
|
case 0x60: ch ++;
|
|
case 0x4c: ch ++;
|
|
case 0x38: /* MCSPI_TX */
|
|
s->ch[ch].tx = value;
|
|
s->ch[ch].status &= ~(1 << 1); /* TXS */
|
|
omap_mcspi_transfer_run(s, ch);
|
|
break;
|
|
|
|
default:
|
|
OMAP_BAD_REG(addr);
|
|
return;
|
|
}
|
|
}
|
|
|
|
static CPUReadMemoryFunc *omap_mcspi_readfn[] = {
|
|
omap_badwidth_read32,
|
|
omap_badwidth_read32,
|
|
omap_mcspi_read,
|
|
};
|
|
|
|
static CPUWriteMemoryFunc *omap_mcspi_writefn[] = {
|
|
omap_badwidth_write32,
|
|
omap_badwidth_write32,
|
|
omap_mcspi_write,
|
|
};
|
|
|
|
struct omap_mcspi_s *omap_mcspi_init(struct omap_target_agent_s *ta, int chnum,
|
|
qemu_irq irq, qemu_irq *drq, omap_clk fclk, omap_clk iclk)
|
|
{
|
|
int iomemtype;
|
|
struct omap_mcspi_s *s = (struct omap_mcspi_s *)
|
|
qemu_mallocz(sizeof(struct omap_mcspi_s));
|
|
struct omap_mcspi_ch_s *ch = s->ch;
|
|
|
|
s->irq = irq;
|
|
s->chnum = chnum;
|
|
while (chnum --) {
|
|
ch->txdrq = *drq ++;
|
|
ch->rxdrq = *drq ++;
|
|
ch ++;
|
|
}
|
|
omap_mcspi_reset(s);
|
|
|
|
iomemtype = l4_register_io_memory(0, omap_mcspi_readfn,
|
|
omap_mcspi_writefn, s);
|
|
s->base = omap_l4_attach(ta, 0, iomemtype);
|
|
|
|
return s;
|
|
}
|
|
|
|
void omap_mcspi_attach(struct omap_mcspi_s *s,
|
|
uint32_t (*txrx)(void *opaque, uint32_t, int), void *opaque,
|
|
int chipselect)
|
|
{
|
|
if (chipselect < 0 || chipselect >= s->chnum)
|
|
cpu_abort(cpu_single_env, "%s: Bad chipselect %i\n",
|
|
__FUNCTION__, chipselect);
|
|
|
|
s->ch[chipselect].txrx = txrx;
|
|
s->ch[chipselect].opaque = opaque;
|
|
}
|
|
|
|
/* STI/XTI (emulation interface) console - reverse engineered only */
|
|
struct omap_sti_s {
|
|
target_phys_addr_t base;
|
|
target_phys_addr_t channel_base;
|
|
qemu_irq irq;
|
|
CharDriverState *chr;
|
|
|
|
uint32_t sysconfig;
|
|
uint32_t systest;
|
|
uint32_t irqst;
|
|
uint32_t irqen;
|
|
uint32_t clkcontrol;
|
|
uint32_t serial_config;
|
|
};
|
|
|
|
#define STI_TRACE_CONSOLE_CHANNEL 239
|
|
#define STI_TRACE_CONTROL_CHANNEL 253
|
|
|
|
static inline void omap_sti_interrupt_update(struct omap_sti_s *s)
|
|
{
|
|
qemu_set_irq(s->irq, s->irqst & s->irqen);
|
|
}
|
|
|
|
static void omap_sti_reset(struct omap_sti_s *s)
|
|
{
|
|
s->sysconfig = 0;
|
|
s->irqst = 0;
|
|
s->irqen = 0;
|
|
s->clkcontrol = 0;
|
|
s->serial_config = 0;
|
|
|
|
omap_sti_interrupt_update(s);
|
|
}
|
|
|
|
static uint32_t omap_sti_read(void *opaque, target_phys_addr_t addr)
|
|
{
|
|
struct omap_sti_s *s = (struct omap_sti_s *) opaque;
|
|
int offset = addr - s->base;
|
|
|
|
switch (offset) {
|
|
case 0x00: /* STI_REVISION */
|
|
return 0x10;
|
|
|
|
case 0x10: /* STI_SYSCONFIG */
|
|
return s->sysconfig;
|
|
|
|
case 0x14: /* STI_SYSSTATUS / STI_RX_STATUS / XTI_SYSSTATUS */
|
|
return 0x00;
|
|
|
|
case 0x18: /* STI_IRQSTATUS */
|
|
return s->irqst;
|
|
|
|
case 0x1c: /* STI_IRQSETEN / STI_IRQCLREN */
|
|
return s->irqen;
|
|
|
|
case 0x24: /* STI_ER / STI_DR / XTI_TRACESELECT */
|
|
case 0x28: /* STI_RX_DR / XTI_RXDATA */
|
|
/* TODO */
|
|
return 0;
|
|
|
|
case 0x2c: /* STI_CLK_CTRL / XTI_SCLKCRTL */
|
|
return s->clkcontrol;
|
|
|
|
case 0x30: /* STI_SERIAL_CFG / XTI_SCONFIG */
|
|
return s->serial_config;
|
|
}
|
|
|
|
OMAP_BAD_REG(addr);
|
|
return 0;
|
|
}
|
|
|
|
static void omap_sti_write(void *opaque, target_phys_addr_t addr,
|
|
uint32_t value)
|
|
{
|
|
struct omap_sti_s *s = (struct omap_sti_s *) opaque;
|
|
int offset = addr - s->base;
|
|
|
|
switch (offset) {
|
|
case 0x00: /* STI_REVISION */
|
|
case 0x14: /* STI_SYSSTATUS / STI_RX_STATUS / XTI_SYSSTATUS */
|
|
OMAP_RO_REG(addr);
|
|
return;
|
|
|
|
case 0x10: /* STI_SYSCONFIG */
|
|
if (value & (1 << 1)) /* SOFTRESET */
|
|
omap_sti_reset(s);
|
|
s->sysconfig = value & 0xfe;
|
|
break;
|
|
|
|
case 0x18: /* STI_IRQSTATUS */
|
|
s->irqst &= ~value;
|
|
omap_sti_interrupt_update(s);
|
|
break;
|
|
|
|
case 0x1c: /* STI_IRQSETEN / STI_IRQCLREN */
|
|
s->irqen = value & 0xffff;
|
|
omap_sti_interrupt_update(s);
|
|
break;
|
|
|
|
case 0x2c: /* STI_CLK_CTRL / XTI_SCLKCRTL */
|
|
s->clkcontrol = value & 0xff;
|
|
break;
|
|
|
|
case 0x30: /* STI_SERIAL_CFG / XTI_SCONFIG */
|
|
s->serial_config = value & 0xff;
|
|
break;
|
|
|
|
case 0x24: /* STI_ER / STI_DR / XTI_TRACESELECT */
|
|
case 0x28: /* STI_RX_DR / XTI_RXDATA */
|
|
/* TODO */
|
|
return;
|
|
|
|
default:
|
|
OMAP_BAD_REG(addr);
|
|
return;
|
|
}
|
|
}
|
|
|
|
static CPUReadMemoryFunc *omap_sti_readfn[] = {
|
|
omap_badwidth_read32,
|
|
omap_badwidth_read32,
|
|
omap_sti_read,
|
|
};
|
|
|
|
static CPUWriteMemoryFunc *omap_sti_writefn[] = {
|
|
omap_badwidth_write32,
|
|
omap_badwidth_write32,
|
|
omap_sti_write,
|
|
};
|
|
|
|
static uint32_t omap_sti_fifo_read(void *opaque, target_phys_addr_t addr)
|
|
{
|
|
OMAP_BAD_REG(addr);
|
|
return 0;
|
|
}
|
|
|
|
static void omap_sti_fifo_write(void *opaque, target_phys_addr_t addr,
|
|
uint32_t value)
|
|
{
|
|
struct omap_sti_s *s = (struct omap_sti_s *) opaque;
|
|
int offset = addr - s->channel_base;
|
|
int ch = offset >> 6;
|
|
uint8_t byte = value;
|
|
|
|
if (ch == STI_TRACE_CONTROL_CHANNEL) {
|
|
/* Flush channel <i>value</i>. */
|
|
qemu_chr_write(s->chr, "\r", 1);
|
|
} else if (ch == STI_TRACE_CONSOLE_CHANNEL || 1) {
|
|
if (value == 0xc0 || value == 0xc3) {
|
|
/* Open channel <i>ch</i>. */
|
|
} else if (value == 0x00)
|
|
qemu_chr_write(s->chr, "\n", 1);
|
|
else
|
|
qemu_chr_write(s->chr, &byte, 1);
|
|
}
|
|
}
|
|
|
|
static CPUReadMemoryFunc *omap_sti_fifo_readfn[] = {
|
|
omap_sti_fifo_read,
|
|
omap_badwidth_read8,
|
|
omap_badwidth_read8,
|
|
};
|
|
|
|
static CPUWriteMemoryFunc *omap_sti_fifo_writefn[] = {
|
|
omap_sti_fifo_write,
|
|
omap_badwidth_write8,
|
|
omap_badwidth_write8,
|
|
};
|
|
|
|
struct omap_sti_s *omap_sti_init(struct omap_target_agent_s *ta,
|
|
target_phys_addr_t channel_base, qemu_irq irq, omap_clk clk,
|
|
CharDriverState *chr)
|
|
{
|
|
int iomemtype;
|
|
struct omap_sti_s *s = (struct omap_sti_s *)
|
|
qemu_mallocz(sizeof(struct omap_sti_s));
|
|
|
|
s->irq = irq;
|
|
omap_sti_reset(s);
|
|
|
|
s->chr = chr ?: qemu_chr_open("null");
|
|
|
|
iomemtype = l4_register_io_memory(0, omap_sti_readfn,
|
|
omap_sti_writefn, s);
|
|
s->base = omap_l4_attach(ta, 0, iomemtype);
|
|
|
|
iomemtype = cpu_register_io_memory(0, omap_sti_fifo_readfn,
|
|
omap_sti_fifo_writefn, s);
|
|
s->channel_base = channel_base;
|
|
cpu_register_physical_memory(s->channel_base, 0x10000, iomemtype);
|
|
|
|
return s;
|
|
}
|
|
|
|
/* L4 Interconnect */
|
|
struct omap_target_agent_s {
|
|
struct omap_l4_s *bus;
|
|
int regions;
|
|
struct omap_l4_region_s *start;
|
|
target_phys_addr_t base;
|
|
uint32_t component;
|
|
uint32_t control;
|
|
uint32_t status;
|
|
};
|
|
|
|
struct omap_l4_s {
|
|
target_phys_addr_t base;
|
|
int ta_num;
|
|
struct omap_target_agent_s ta[0];
|
|
};
|
|
|
|
#ifdef L4_MUX_HACK
|
|
static int omap_l4_io_entries;
|
|
static int omap_cpu_io_entry;
|
|
static struct omap_l4_entry {
|
|
CPUReadMemoryFunc **mem_read;
|
|
CPUWriteMemoryFunc **mem_write;
|
|
void *opaque;
|
|
} *omap_l4_io_entry;
|
|
static CPUReadMemoryFunc **omap_l4_io_readb_fn;
|
|
static CPUReadMemoryFunc **omap_l4_io_readh_fn;
|
|
static CPUReadMemoryFunc **omap_l4_io_readw_fn;
|
|
static CPUWriteMemoryFunc **omap_l4_io_writeb_fn;
|
|
static CPUWriteMemoryFunc **omap_l4_io_writeh_fn;
|
|
static CPUWriteMemoryFunc **omap_l4_io_writew_fn;
|
|
static void **omap_l4_io_opaque;
|
|
|
|
int l4_register_io_memory(int io_index, CPUReadMemoryFunc **mem_read,
|
|
CPUWriteMemoryFunc **mem_write, void *opaque)
|
|
{
|
|
omap_l4_io_entry[omap_l4_io_entries].mem_read = mem_read;
|
|
omap_l4_io_entry[omap_l4_io_entries].mem_write = mem_write;
|
|
omap_l4_io_entry[omap_l4_io_entries].opaque = opaque;
|
|
|
|
return omap_l4_io_entries ++;
|
|
}
|
|
|
|
static uint32_t omap_l4_io_readb(void *opaque, target_phys_addr_t addr)
|
|
{
|
|
unsigned int i = (addr - OMAP2_L4_BASE) >> TARGET_PAGE_BITS;
|
|
|
|
return omap_l4_io_readb_fn[i](omap_l4_io_opaque[i], addr);
|
|
}
|
|
|
|
static uint32_t omap_l4_io_readh(void *opaque, target_phys_addr_t addr)
|
|
{
|
|
unsigned int i = (addr - OMAP2_L4_BASE) >> TARGET_PAGE_BITS;
|
|
|
|
return omap_l4_io_readh_fn[i](omap_l4_io_opaque[i], addr);
|
|
}
|
|
|
|
static uint32_t omap_l4_io_readw(void *opaque, target_phys_addr_t addr)
|
|
{
|
|
unsigned int i = (addr - OMAP2_L4_BASE) >> TARGET_PAGE_BITS;
|
|
|
|
return omap_l4_io_readw_fn[i](omap_l4_io_opaque[i], addr);
|
|
}
|
|
|
|
static void omap_l4_io_writeb(void *opaque, target_phys_addr_t addr,
|
|
uint32_t value)
|
|
{
|
|
unsigned int i = (addr - OMAP2_L4_BASE) >> TARGET_PAGE_BITS;
|
|
|
|
return omap_l4_io_writeb_fn[i](omap_l4_io_opaque[i], addr, value);
|
|
}
|
|
|
|
static void omap_l4_io_writeh(void *opaque, target_phys_addr_t addr,
|
|
uint32_t value)
|
|
{
|
|
unsigned int i = (addr - OMAP2_L4_BASE) >> TARGET_PAGE_BITS;
|
|
|
|
return omap_l4_io_writeh_fn[i](omap_l4_io_opaque[i], addr, value);
|
|
}
|
|
|
|
static void omap_l4_io_writew(void *opaque, target_phys_addr_t addr,
|
|
uint32_t value)
|
|
{
|
|
unsigned int i = (addr - OMAP2_L4_BASE) >> TARGET_PAGE_BITS;
|
|
|
|
return omap_l4_io_writew_fn[i](omap_l4_io_opaque[i], addr, value);
|
|
}
|
|
|
|
static CPUReadMemoryFunc *omap_l4_io_readfn[] = {
|
|
omap_l4_io_readb,
|
|
omap_l4_io_readh,
|
|
omap_l4_io_readw,
|
|
};
|
|
|
|
static CPUWriteMemoryFunc *omap_l4_io_writefn[] = {
|
|
omap_l4_io_writeb,
|
|
omap_l4_io_writeh,
|
|
omap_l4_io_writew,
|
|
};
|
|
#endif
|
|
|
|
struct omap_l4_s *omap_l4_init(target_phys_addr_t base, int ta_num)
|
|
{
|
|
struct omap_l4_s *bus = qemu_mallocz(
|
|
sizeof(*bus) + ta_num * sizeof(*bus->ta));
|
|
|
|
bus->ta_num = ta_num;
|
|
bus->base = base;
|
|
|
|
#ifdef L4_MUX_HACK
|
|
omap_l4_io_entries = 1;
|
|
omap_l4_io_entry = qemu_mallocz(125 * sizeof(*omap_l4_io_entry));
|
|
|
|
omap_cpu_io_entry =
|
|
cpu_register_io_memory(0, omap_l4_io_readfn,
|
|
omap_l4_io_writefn, bus);
|
|
# define L4_PAGES (0xb4000 / TARGET_PAGE_SIZE)
|
|
omap_l4_io_readb_fn = qemu_mallocz(sizeof(void *) * L4_PAGES);
|
|
omap_l4_io_readh_fn = qemu_mallocz(sizeof(void *) * L4_PAGES);
|
|
omap_l4_io_readw_fn = qemu_mallocz(sizeof(void *) * L4_PAGES);
|
|
omap_l4_io_writeb_fn = qemu_mallocz(sizeof(void *) * L4_PAGES);
|
|
omap_l4_io_writeh_fn = qemu_mallocz(sizeof(void *) * L4_PAGES);
|
|
omap_l4_io_writew_fn = qemu_mallocz(sizeof(void *) * L4_PAGES);
|
|
omap_l4_io_opaque = qemu_mallocz(sizeof(void *) * L4_PAGES);
|
|
#endif
|
|
|
|
return bus;
|
|
}
|
|
|
|
static uint32_t omap_l4ta_read(void *opaque, target_phys_addr_t addr)
|
|
{
|
|
struct omap_target_agent_s *s = (struct omap_target_agent_s *) opaque;
|
|
target_phys_addr_t reg = addr - s->base;
|
|
|
|
switch (reg) {
|
|
case 0x00: /* COMPONENT */
|
|
return s->component;
|
|
|
|
case 0x20: /* AGENT_CONTROL */
|
|
return s->control;
|
|
|
|
case 0x28: /* AGENT_STATUS */
|
|
return s->status;
|
|
}
|
|
|
|
OMAP_BAD_REG(addr);
|
|
return 0;
|
|
}
|
|
|
|
static void omap_l4ta_write(void *opaque, target_phys_addr_t addr,
|
|
uint32_t value)
|
|
{
|
|
struct omap_target_agent_s *s = (struct omap_target_agent_s *) opaque;
|
|
target_phys_addr_t reg = addr - s->base;
|
|
|
|
switch (reg) {
|
|
case 0x00: /* COMPONENT */
|
|
case 0x28: /* AGENT_STATUS */
|
|
OMAP_RO_REG(addr);
|
|
break;
|
|
|
|
case 0x20: /* AGENT_CONTROL */
|
|
s->control = value & 0x01000700;
|
|
if (value & 1) /* OCP_RESET */
|
|
s->status &= ~1; /* REQ_TIMEOUT */
|
|
break;
|
|
|
|
default:
|
|
OMAP_BAD_REG(addr);
|
|
}
|
|
}
|
|
|
|
static CPUReadMemoryFunc *omap_l4ta_readfn[] = {
|
|
omap_badwidth_read16,
|
|
omap_l4ta_read,
|
|
omap_badwidth_read16,
|
|
};
|
|
|
|
static CPUWriteMemoryFunc *omap_l4ta_writefn[] = {
|
|
omap_badwidth_write32,
|
|
omap_badwidth_write32,
|
|
omap_l4ta_write,
|
|
};
|
|
|
|
#define L4TA(n) (n)
|
|
#define L4TAO(n) ((n) + 39)
|
|
|
|
static struct omap_l4_region_s {
|
|
target_phys_addr_t offset;
|
|
size_t size;
|
|
int access;
|
|
} omap_l4_region[125] = {
|
|
[ 1] = { 0x40800, 0x800, 32 }, /* Initiator agent */
|
|
[ 2] = { 0x41000, 0x1000, 32 }, /* Link agent */
|
|
[ 0] = { 0x40000, 0x800, 32 }, /* Address and protection */
|
|
[ 3] = { 0x00000, 0x1000, 32 | 16 | 8 }, /* System Control and Pinout */
|
|
[ 4] = { 0x01000, 0x1000, 32 | 16 | 8 }, /* L4TAO1 */
|
|
[ 5] = { 0x04000, 0x1000, 32 | 16 }, /* 32K Timer */
|
|
[ 6] = { 0x05000, 0x1000, 32 | 16 | 8 }, /* L4TAO2 */
|
|
[ 7] = { 0x08000, 0x800, 32 }, /* PRCM Region A */
|
|
[ 8] = { 0x08800, 0x800, 32 }, /* PRCM Region B */
|
|
[ 9] = { 0x09000, 0x1000, 32 | 16 | 8 }, /* L4TAO */
|
|
[ 10] = { 0x12000, 0x1000, 32 | 16 | 8 }, /* Test (BCM) */
|
|
[ 11] = { 0x13000, 0x1000, 32 | 16 | 8 }, /* L4TA1 */
|
|
[ 12] = { 0x14000, 0x1000, 32 }, /* Test/emulation (TAP) */
|
|
[ 13] = { 0x15000, 0x1000, 32 | 16 | 8 }, /* L4TA2 */
|
|
[ 14] = { 0x18000, 0x1000, 32 | 16 | 8 }, /* GPIO1 */
|
|
[ 16] = { 0x1a000, 0x1000, 32 | 16 | 8 }, /* GPIO2 */
|
|
[ 18] = { 0x1c000, 0x1000, 32 | 16 | 8 }, /* GPIO3 */
|
|
[ 19] = { 0x1e000, 0x1000, 32 | 16 | 8 }, /* GPIO4 */
|
|
[ 15] = { 0x19000, 0x1000, 32 | 16 | 8 }, /* Quad GPIO TOP */
|
|
[ 17] = { 0x1b000, 0x1000, 32 | 16 | 8 }, /* L4TA3 */
|
|
[ 20] = { 0x20000, 0x1000, 32 | 16 | 8 }, /* WD Timer 1 (Secure) */
|
|
[ 22] = { 0x22000, 0x1000, 32 | 16 | 8 }, /* WD Timer 2 (OMAP) */
|
|
[ 21] = { 0x21000, 0x1000, 32 | 16 | 8 }, /* Dual WD timer TOP */
|
|
[ 23] = { 0x23000, 0x1000, 32 | 16 | 8 }, /* L4TA4 */
|
|
[ 24] = { 0x28000, 0x1000, 32 | 16 | 8 }, /* GP Timer 1 */
|
|
[ 25] = { 0x29000, 0x1000, 32 | 16 | 8 }, /* L4TA7 */
|
|
[ 26] = { 0x48000, 0x2000, 32 | 16 | 8 }, /* Emulation (ARM11ETB) */
|
|
[ 27] = { 0x4a000, 0x1000, 32 | 16 | 8 }, /* L4TA9 */
|
|
[ 28] = { 0x50000, 0x400, 32 | 16 | 8 }, /* Display top */
|
|
[ 29] = { 0x50400, 0x400, 32 | 16 | 8 }, /* Display control */
|
|
[ 30] = { 0x50800, 0x400, 32 | 16 | 8 }, /* Display RFBI */
|
|
[ 31] = { 0x50c00, 0x400, 32 | 16 | 8 }, /* Display encoder */
|
|
[ 32] = { 0x51000, 0x1000, 32 | 16 | 8 }, /* L4TA10 */
|
|
[ 33] = { 0x52000, 0x400, 32 | 16 | 8 }, /* Camera top */
|
|
[ 34] = { 0x52400, 0x400, 32 | 16 | 8 }, /* Camera core */
|
|
[ 35] = { 0x52800, 0x400, 32 | 16 | 8 }, /* Camera DMA */
|
|
[ 36] = { 0x52c00, 0x400, 32 | 16 | 8 }, /* Camera MMU */
|
|
[ 37] = { 0x53000, 0x1000, 32 | 16 | 8 }, /* L4TA11 */
|
|
[ 38] = { 0x56000, 0x1000, 32 | 16 | 8 }, /* sDMA */
|
|
[ 39] = { 0x57000, 0x1000, 32 | 16 | 8 }, /* L4TA12 */
|
|
[ 40] = { 0x58000, 0x1000, 32 | 16 | 8 }, /* SSI top */
|
|
[ 41] = { 0x59000, 0x1000, 32 | 16 | 8 }, /* SSI GDD */
|
|
[ 42] = { 0x5a000, 0x1000, 32 | 16 | 8 }, /* SSI Port1 */
|
|
[ 43] = { 0x5b000, 0x1000, 32 | 16 | 8 }, /* SSI Port2 */
|
|
[ 44] = { 0x5c000, 0x1000, 32 | 16 | 8 }, /* L4TA13 */
|
|
[ 45] = { 0x5e000, 0x1000, 32 | 16 | 8 }, /* USB OTG */
|
|
[ 46] = { 0x5f000, 0x1000, 32 | 16 | 8 }, /* L4TAO4 */
|
|
[ 47] = { 0x60000, 0x1000, 32 | 16 | 8 }, /* Emulation (WIN_TRACER1SDRC) */
|
|
[ 48] = { 0x61000, 0x1000, 32 | 16 | 8 }, /* L4TA14 */
|
|
[ 49] = { 0x62000, 0x1000, 32 | 16 | 8 }, /* Emulation (WIN_TRACER2GPMC) */
|
|
[ 50] = { 0x63000, 0x1000, 32 | 16 | 8 }, /* L4TA15 */
|
|
[ 51] = { 0x64000, 0x1000, 32 | 16 | 8 }, /* Emulation (WIN_TRACER3OCM) */
|
|
[ 52] = { 0x65000, 0x1000, 32 | 16 | 8 }, /* L4TA16 */
|
|
[ 53] = { 0x66000, 0x300, 32 | 16 | 8 }, /* Emulation (WIN_TRACER4L4) */
|
|
[ 54] = { 0x67000, 0x1000, 32 | 16 | 8 }, /* L4TA17 */
|
|
[ 55] = { 0x68000, 0x1000, 32 | 16 | 8 }, /* Emulation (XTI) */
|
|
[ 56] = { 0x69000, 0x1000, 32 | 16 | 8 }, /* L4TA18 */
|
|
[ 57] = { 0x6a000, 0x1000, 16 | 8 }, /* UART1 */
|
|
[ 58] = { 0x6b000, 0x1000, 32 | 16 | 8 }, /* L4TA19 */
|
|
[ 59] = { 0x6c000, 0x1000, 16 | 8 }, /* UART2 */
|
|
[ 60] = { 0x6d000, 0x1000, 32 | 16 | 8 }, /* L4TA20 */
|
|
[ 61] = { 0x6e000, 0x1000, 16 | 8 }, /* UART3 */
|
|
[ 62] = { 0x6f000, 0x1000, 32 | 16 | 8 }, /* L4TA21 */
|
|
[ 63] = { 0x70000, 0x1000, 16 }, /* I2C1 */
|
|
[ 64] = { 0x71000, 0x1000, 32 | 16 | 8 }, /* L4TAO5 */
|
|
[ 65] = { 0x72000, 0x1000, 16 }, /* I2C2 */
|
|
[ 66] = { 0x73000, 0x1000, 32 | 16 | 8 }, /* L4TAO6 */
|
|
[ 67] = { 0x74000, 0x1000, 16 }, /* McBSP1 */
|
|
[ 68] = { 0x75000, 0x1000, 32 | 16 | 8 }, /* L4TAO7 */
|
|
[ 69] = { 0x76000, 0x1000, 16 }, /* McBSP2 */
|
|
[ 70] = { 0x77000, 0x1000, 32 | 16 | 8 }, /* L4TAO8 */
|
|
[ 71] = { 0x24000, 0x1000, 32 | 16 | 8 }, /* WD Timer 3 (DSP) */
|
|
[ 72] = { 0x25000, 0x1000, 32 | 16 | 8 }, /* L4TA5 */
|
|
[ 73] = { 0x26000, 0x1000, 32 | 16 | 8 }, /* WD Timer 4 (IVA) */
|
|
[ 74] = { 0x27000, 0x1000, 32 | 16 | 8 }, /* L4TA6 */
|
|
[ 75] = { 0x2a000, 0x1000, 32 | 16 | 8 }, /* GP Timer 2 */
|
|
[ 76] = { 0x2b000, 0x1000, 32 | 16 | 8 }, /* L4TA8 */
|
|
[ 77] = { 0x78000, 0x1000, 32 | 16 | 8 }, /* GP Timer 3 */
|
|
[ 78] = { 0x79000, 0x1000, 32 | 16 | 8 }, /* L4TA22 */
|
|
[ 79] = { 0x7a000, 0x1000, 32 | 16 | 8 }, /* GP Timer 4 */
|
|
[ 80] = { 0x7b000, 0x1000, 32 | 16 | 8 }, /* L4TA23 */
|
|
[ 81] = { 0x7c000, 0x1000, 32 | 16 | 8 }, /* GP Timer 5 */
|
|
[ 82] = { 0x7d000, 0x1000, 32 | 16 | 8 }, /* L4TA24 */
|
|
[ 83] = { 0x7e000, 0x1000, 32 | 16 | 8 }, /* GP Timer 6 */
|
|
[ 84] = { 0x7f000, 0x1000, 32 | 16 | 8 }, /* L4TA25 */
|
|
[ 85] = { 0x80000, 0x1000, 32 | 16 | 8 }, /* GP Timer 7 */
|
|
[ 86] = { 0x81000, 0x1000, 32 | 16 | 8 }, /* L4TA26 */
|
|
[ 87] = { 0x82000, 0x1000, 32 | 16 | 8 }, /* GP Timer 8 */
|
|
[ 88] = { 0x83000, 0x1000, 32 | 16 | 8 }, /* L4TA27 */
|
|
[ 89] = { 0x84000, 0x1000, 32 | 16 | 8 }, /* GP Timer 9 */
|
|
[ 90] = { 0x85000, 0x1000, 32 | 16 | 8 }, /* L4TA28 */
|
|
[ 91] = { 0x86000, 0x1000, 32 | 16 | 8 }, /* GP Timer 10 */
|
|
[ 92] = { 0x87000, 0x1000, 32 | 16 | 8 }, /* L4TA29 */
|
|
[ 93] = { 0x88000, 0x1000, 32 | 16 | 8 }, /* GP Timer 11 */
|
|
[ 94] = { 0x89000, 0x1000, 32 | 16 | 8 }, /* L4TA30 */
|
|
[ 95] = { 0x8a000, 0x1000, 32 | 16 | 8 }, /* GP Timer 12 */
|
|
[ 96] = { 0x8b000, 0x1000, 32 | 16 | 8 }, /* L4TA31 */
|
|
[ 97] = { 0x90000, 0x1000, 16 }, /* EAC */
|
|
[ 98] = { 0x91000, 0x1000, 32 | 16 | 8 }, /* L4TA32 */
|
|
[ 99] = { 0x92000, 0x1000, 16 }, /* FAC */
|
|
[100] = { 0x93000, 0x1000, 32 | 16 | 8 }, /* L4TA33 */
|
|
[101] = { 0x94000, 0x1000, 32 | 16 | 8 }, /* IPC (MAILBOX) */
|
|
[102] = { 0x95000, 0x1000, 32 | 16 | 8 }, /* L4TA34 */
|
|
[103] = { 0x98000, 0x1000, 32 | 16 | 8 }, /* SPI1 */
|
|
[104] = { 0x99000, 0x1000, 32 | 16 | 8 }, /* L4TA35 */
|
|
[105] = { 0x9a000, 0x1000, 32 | 16 | 8 }, /* SPI2 */
|
|
[106] = { 0x9b000, 0x1000, 32 | 16 | 8 }, /* L4TA36 */
|
|
[107] = { 0x9c000, 0x1000, 16 | 8 }, /* MMC SDIO */
|
|
[108] = { 0x9d000, 0x1000, 32 | 16 | 8 }, /* L4TAO9 */
|
|
[109] = { 0x9e000, 0x1000, 32 | 16 | 8 }, /* MS_PRO */
|
|
[110] = { 0x9f000, 0x1000, 32 | 16 | 8 }, /* L4TAO10 */
|
|
[111] = { 0xa0000, 0x1000, 32 }, /* RNG */
|
|
[112] = { 0xa1000, 0x1000, 32 | 16 | 8 }, /* L4TAO11 */
|
|
[113] = { 0xa2000, 0x1000, 32 }, /* DES3DES */
|
|
[114] = { 0xa3000, 0x1000, 32 | 16 | 8 }, /* L4TAO12 */
|
|
[115] = { 0xa4000, 0x1000, 32 }, /* SHA1MD5 */
|
|
[116] = { 0xa5000, 0x1000, 32 | 16 | 8 }, /* L4TAO13 */
|
|
[117] = { 0xa6000, 0x1000, 32 }, /* AES */
|
|
[118] = { 0xa7000, 0x1000, 32 | 16 | 8 }, /* L4TA37 */
|
|
[119] = { 0xa8000, 0x2000, 32 }, /* PKA */
|
|
[120] = { 0xaa000, 0x1000, 32 | 16 | 8 }, /* L4TA38 */
|
|
[121] = { 0xb0000, 0x1000, 32 }, /* MG */
|
|
[122] = { 0xb1000, 0x1000, 32 | 16 | 8 },
|
|
[123] = { 0xb2000, 0x1000, 32 }, /* HDQ/1-Wire */
|
|
[124] = { 0xb3000, 0x1000, 32 | 16 | 8 }, /* L4TA39 */
|
|
};
|
|
|
|
static struct omap_l4_agent_info_s {
|
|
int ta;
|
|
int region;
|
|
int regions;
|
|
int ta_region;
|
|
} omap_l4_agent_info[54] = {
|
|
{ 0, 0, 3, 2 }, /* L4IA initiatior agent */
|
|
{ L4TAO(1), 3, 2, 1 }, /* Control and pinout module */
|
|
{ L4TAO(2), 5, 2, 1 }, /* 32K timer */
|
|
{ L4TAO(3), 7, 3, 2 }, /* PRCM */
|
|
{ L4TA(1), 10, 2, 1 }, /* BCM */
|
|
{ L4TA(2), 12, 2, 1 }, /* Test JTAG */
|
|
{ L4TA(3), 14, 6, 3 }, /* Quad GPIO */
|
|
{ L4TA(4), 20, 4, 3 }, /* WD timer 1/2 */
|
|
{ L4TA(7), 24, 2, 1 }, /* GP timer 1 */
|
|
{ L4TA(9), 26, 2, 1 }, /* ATM11 ETB */
|
|
{ L4TA(10), 28, 5, 4 }, /* Display subsystem */
|
|
{ L4TA(11), 33, 5, 4 }, /* Camera subsystem */
|
|
{ L4TA(12), 38, 2, 1 }, /* sDMA */
|
|
{ L4TA(13), 40, 5, 4 }, /* SSI */
|
|
{ L4TAO(4), 45, 2, 1 }, /* USB */
|
|
{ L4TA(14), 47, 2, 1 }, /* Win Tracer1 */
|
|
{ L4TA(15), 49, 2, 1 }, /* Win Tracer2 */
|
|
{ L4TA(16), 51, 2, 1 }, /* Win Tracer3 */
|
|
{ L4TA(17), 53, 2, 1 }, /* Win Tracer4 */
|
|
{ L4TA(18), 55, 2, 1 }, /* XTI */
|
|
{ L4TA(19), 57, 2, 1 }, /* UART1 */
|
|
{ L4TA(20), 59, 2, 1 }, /* UART2 */
|
|
{ L4TA(21), 61, 2, 1 }, /* UART3 */
|
|
{ L4TAO(5), 63, 2, 1 }, /* I2C1 */
|
|
{ L4TAO(6), 65, 2, 1 }, /* I2C2 */
|
|
{ L4TAO(7), 67, 2, 1 }, /* McBSP1 */
|
|
{ L4TAO(8), 69, 2, 1 }, /* McBSP2 */
|
|
{ L4TA(5), 71, 2, 1 }, /* WD Timer 3 (DSP) */
|
|
{ L4TA(6), 73, 2, 1 }, /* WD Timer 4 (IVA) */
|
|
{ L4TA(8), 75, 2, 1 }, /* GP Timer 2 */
|
|
{ L4TA(22), 77, 2, 1 }, /* GP Timer 3 */
|
|
{ L4TA(23), 79, 2, 1 }, /* GP Timer 4 */
|
|
{ L4TA(24), 81, 2, 1 }, /* GP Timer 5 */
|
|
{ L4TA(25), 83, 2, 1 }, /* GP Timer 6 */
|
|
{ L4TA(26), 85, 2, 1 }, /* GP Timer 7 */
|
|
{ L4TA(27), 87, 2, 1 }, /* GP Timer 8 */
|
|
{ L4TA(28), 89, 2, 1 }, /* GP Timer 9 */
|
|
{ L4TA(29), 91, 2, 1 }, /* GP Timer 10 */
|
|
{ L4TA(30), 93, 2, 1 }, /* GP Timer 11 */
|
|
{ L4TA(31), 95, 2, 1 }, /* GP Timer 12 */
|
|
{ L4TA(32), 97, 2, 1 }, /* EAC */
|
|
{ L4TA(33), 99, 2, 1 }, /* FAC */
|
|
{ L4TA(34), 101, 2, 1 }, /* IPC */
|
|
{ L4TA(35), 103, 2, 1 }, /* SPI1 */
|
|
{ L4TA(36), 105, 2, 1 }, /* SPI2 */
|
|
{ L4TAO(9), 107, 2, 1 }, /* MMC SDIO */
|
|
{ L4TAO(10), 109, 2, 1 },
|
|
{ L4TAO(11), 111, 2, 1 }, /* RNG */
|
|
{ L4TAO(12), 113, 2, 1 }, /* DES3DES */
|
|
{ L4TAO(13), 115, 2, 1 }, /* SHA1MD5 */
|
|
{ L4TA(37), 117, 2, 1 }, /* AES */
|
|
{ L4TA(38), 119, 2, 1 }, /* PKA */
|
|
{ -1, 121, 2, 1 },
|
|
{ L4TA(39), 123, 2, 1 }, /* HDQ/1-Wire */
|
|
};
|
|
|
|
#define omap_l4ta(bus, cs) omap_l4ta_get(bus, L4TA(cs))
|
|
#define omap_l4tao(bus, cs) omap_l4ta_get(bus, L4TAO(cs))
|
|
|
|
struct omap_target_agent_s *omap_l4ta_get(struct omap_l4_s *bus, int cs)
|
|
{
|
|
int i, iomemtype;
|
|
struct omap_target_agent_s *ta = 0;
|
|
struct omap_l4_agent_info_s *info = 0;
|
|
|
|
for (i = 0; i < bus->ta_num; i ++)
|
|
if (omap_l4_agent_info[i].ta == cs) {
|
|
ta = &bus->ta[i];
|
|
info = &omap_l4_agent_info[i];
|
|
break;
|
|
}
|
|
if (!ta) {
|
|
fprintf(stderr, "%s: bad target agent (%i)\n", __FUNCTION__, cs);
|
|
exit(-1);
|
|
}
|
|
|
|
ta->bus = bus;
|
|
ta->start = &omap_l4_region[info->region];
|
|
ta->regions = info->regions;
|
|
|
|
ta->component = ('Q' << 24) | ('E' << 16) | ('M' << 8) | ('U' << 0);
|
|
ta->status = 0x00000000;
|
|
ta->control = 0x00000200; /* XXX 01000200 for L4TAO */
|
|
|
|
iomemtype = l4_register_io_memory(0, omap_l4ta_readfn,
|
|
omap_l4ta_writefn, ta);
|
|
ta->base = omap_l4_attach(ta, info->ta_region, iomemtype);
|
|
|
|
return ta;
|
|
}
|
|
|
|
target_phys_addr_t omap_l4_attach(struct omap_target_agent_s *ta, int region,
|
|
int iotype)
|
|
{
|
|
target_phys_addr_t base;
|
|
ssize_t size;
|
|
#ifdef L4_MUX_HACK
|
|
int i;
|
|
#endif
|
|
|
|
if (region < 0 || region >= ta->regions) {
|
|
fprintf(stderr, "%s: bad io region (%i)\n", __FUNCTION__, region);
|
|
exit(-1);
|
|
}
|
|
|
|
base = ta->bus->base + ta->start[region].offset;
|
|
size = ta->start[region].size;
|
|
if (iotype) {
|
|
#ifndef L4_MUX_HACK
|
|
cpu_register_physical_memory(base, size, iotype);
|
|
#else
|
|
cpu_register_physical_memory(base, size, omap_cpu_io_entry);
|
|
i = (base - ta->bus->base) / TARGET_PAGE_SIZE;
|
|
for (; size > 0; size -= TARGET_PAGE_SIZE, i ++) {
|
|
omap_l4_io_readb_fn[i] = omap_l4_io_entry[iotype].mem_read[0];
|
|
omap_l4_io_readh_fn[i] = omap_l4_io_entry[iotype].mem_read[1];
|
|
omap_l4_io_readw_fn[i] = omap_l4_io_entry[iotype].mem_read[2];
|
|
omap_l4_io_writeb_fn[i] = omap_l4_io_entry[iotype].mem_write[0];
|
|
omap_l4_io_writeh_fn[i] = omap_l4_io_entry[iotype].mem_write[1];
|
|
omap_l4_io_writew_fn[i] = omap_l4_io_entry[iotype].mem_write[2];
|
|
omap_l4_io_opaque[i] = omap_l4_io_entry[iotype].opaque;
|
|
}
|
|
#endif
|
|
}
|
|
|
|
return base;
|
|
}
|
|
|
|
/* TEST-Chip-level TAP */
|
|
static uint32_t omap_tap_read(void *opaque, target_phys_addr_t addr)
|
|
{
|
|
struct omap_mpu_state_s *s = (struct omap_mpu_state_s *) opaque;
|
|
target_phys_addr_t reg = addr - s->tap_base;
|
|
|
|
switch (reg) {
|
|
case 0x204: /* IDCODE_reg */
|
|
switch (s->mpu_model) {
|
|
case omap2420:
|
|
case omap2422:
|
|
case omap2423:
|
|
return 0x5b5d902f; /* ES 2.2 */
|
|
case omap2430:
|
|
return 0x5b68a02f; /* ES 2.2 */
|
|
case omap3430:
|
|
return 0x1b7ae02f; /* ES 2 */
|
|
default:
|
|
cpu_abort(cpu_single_env, "%s: Bad mpu model\n", __FUNCTION__);
|
|
}
|
|
|
|
case 0x208: /* PRODUCTION_ID_reg for OMAP2 */
|
|
case 0x210: /* PRODUCTION_ID_reg for OMAP3 */
|
|
switch (s->mpu_model) {
|
|
case omap2420:
|
|
return 0x000254f0; /* POP ESHS2.1.1 in N91/93/95, ES2 in N800 */
|
|
case omap2422:
|
|
return 0x000400f0;
|
|
case omap2423:
|
|
return 0x000800f0;
|
|
case omap2430:
|
|
return 0x000000f0;
|
|
case omap3430:
|
|
return 0x000000f0;
|
|
default:
|
|
cpu_abort(cpu_single_env, "%s: Bad mpu model\n", __FUNCTION__);
|
|
}
|
|
|
|
case 0x20c:
|
|
switch (s->mpu_model) {
|
|
case omap2420:
|
|
case omap2422:
|
|
case omap2423:
|
|
return 0xcafeb5d9; /* ES 2.2 */
|
|
case omap2430:
|
|
return 0xcafeb68a; /* ES 2.2 */
|
|
case omap3430:
|
|
return 0xcafeb7ae; /* ES 2 */
|
|
default:
|
|
cpu_abort(cpu_single_env, "%s: Bad mpu model\n", __FUNCTION__);
|
|
}
|
|
|
|
case 0x218: /* DIE_ID_reg */
|
|
return ('Q' << 24) | ('E' << 16) | ('M' << 8) | ('U' << 0);
|
|
case 0x21c: /* DIE_ID_reg */
|
|
return 0x54 << 24;
|
|
case 0x220: /* DIE_ID_reg */
|
|
return ('Q' << 24) | ('E' << 16) | ('M' << 8) | ('U' << 0);
|
|
case 0x224: /* DIE_ID_reg */
|
|
return ('Q' << 24) | ('E' << 16) | ('M' << 8) | ('U' << 0);
|
|
}
|
|
|
|
OMAP_BAD_REG(addr);
|
|
return 0;
|
|
}
|
|
|
|
static void omap_tap_write(void *opaque, target_phys_addr_t addr,
|
|
uint32_t value)
|
|
{
|
|
OMAP_BAD_REG(addr);
|
|
}
|
|
|
|
static CPUReadMemoryFunc *omap_tap_readfn[] = {
|
|
omap_badwidth_read32,
|
|
omap_badwidth_read32,
|
|
omap_tap_read,
|
|
};
|
|
|
|
static CPUWriteMemoryFunc *omap_tap_writefn[] = {
|
|
omap_badwidth_write32,
|
|
omap_badwidth_write32,
|
|
omap_tap_write,
|
|
};
|
|
|
|
void omap_tap_init(struct omap_target_agent_s *ta,
|
|
struct omap_mpu_state_s *mpu)
|
|
{
|
|
mpu->tap_base = omap_l4_attach(ta, 0, l4_register_io_memory(0,
|
|
omap_tap_readfn, omap_tap_writefn, mpu));
|
|
}
|
|
|
|
/* Power, Reset, and Clock Management */
|
|
struct omap_prcm_s {
|
|
target_phys_addr_t base;
|
|
qemu_irq irq[3];
|
|
struct omap_mpu_state_s *mpu;
|
|
|
|
uint32_t irqst[3];
|
|
uint32_t irqen[3];
|
|
|
|
uint32_t sysconfig;
|
|
uint32_t voltctrl;
|
|
uint32_t scratch[20];
|
|
|
|
uint32_t clksrc[1];
|
|
uint32_t clkout[1];
|
|
uint32_t clkemul[1];
|
|
uint32_t clkpol[1];
|
|
uint32_t clksel[8];
|
|
uint32_t clken[12];
|
|
uint32_t clkctrl[4];
|
|
uint32_t clkidle[7];
|
|
uint32_t setuptime[2];
|
|
|
|
uint32_t wkup[3];
|
|
uint32_t wken[3];
|
|
uint32_t wkst[3];
|
|
uint32_t rst[4];
|
|
uint32_t rstctrl[1];
|
|
uint32_t power[4];
|
|
uint32_t rsttime_wkup;
|
|
|
|
uint32_t ev;
|
|
uint32_t evtime[2];
|
|
};
|
|
|
|
static void omap_prcm_int_update(struct omap_prcm_s *s, int dom)
|
|
{
|
|
qemu_set_irq(s->irq[dom], s->irqst[dom] & s->irqen[dom]);
|
|
/* XXX or is the mask applied before PRCM_IRQSTATUS_* ? */
|
|
}
|
|
|
|
static uint32_t omap_prcm_read(void *opaque, target_phys_addr_t addr)
|
|
{
|
|
struct omap_prcm_s *s = (struct omap_prcm_s *) opaque;
|
|
int offset = addr - s->base;
|
|
|
|
switch (offset) {
|
|
case 0x000: /* PRCM_REVISION */
|
|
return 0x10;
|
|
|
|
case 0x010: /* PRCM_SYSCONFIG */
|
|
return s->sysconfig;
|
|
|
|
case 0x018: /* PRCM_IRQSTATUS_MPU */
|
|
return s->irqst[0];
|
|
|
|
case 0x01c: /* PRCM_IRQENABLE_MPU */
|
|
return s->irqen[0];
|
|
|
|
case 0x050: /* PRCM_VOLTCTRL */
|
|
return s->voltctrl;
|
|
case 0x054: /* PRCM_VOLTST */
|
|
return s->voltctrl & 3;
|
|
|
|
case 0x060: /* PRCM_CLKSRC_CTRL */
|
|
return s->clksrc[0];
|
|
case 0x070: /* PRCM_CLKOUT_CTRL */
|
|
return s->clkout[0];
|
|
case 0x078: /* PRCM_CLKEMUL_CTRL */
|
|
return s->clkemul[0];
|
|
case 0x080: /* PRCM_CLKCFG_CTRL */
|
|
case 0x084: /* PRCM_CLKCFG_STATUS */
|
|
return 0;
|
|
|
|
case 0x090: /* PRCM_VOLTSETUP */
|
|
return s->setuptime[0];
|
|
|
|
case 0x094: /* PRCM_CLKSSETUP */
|
|
return s->setuptime[1];
|
|
|
|
case 0x098: /* PRCM_POLCTRL */
|
|
return s->clkpol[0];
|
|
|
|
case 0x0b0: /* GENERAL_PURPOSE1 */
|
|
case 0x0b4: /* GENERAL_PURPOSE2 */
|
|
case 0x0b8: /* GENERAL_PURPOSE3 */
|
|
case 0x0bc: /* GENERAL_PURPOSE4 */
|
|
case 0x0c0: /* GENERAL_PURPOSE5 */
|
|
case 0x0c4: /* GENERAL_PURPOSE6 */
|
|
case 0x0c8: /* GENERAL_PURPOSE7 */
|
|
case 0x0cc: /* GENERAL_PURPOSE8 */
|
|
case 0x0d0: /* GENERAL_PURPOSE9 */
|
|
case 0x0d4: /* GENERAL_PURPOSE10 */
|
|
case 0x0d8: /* GENERAL_PURPOSE11 */
|
|
case 0x0dc: /* GENERAL_PURPOSE12 */
|
|
case 0x0e0: /* GENERAL_PURPOSE13 */
|
|
case 0x0e4: /* GENERAL_PURPOSE14 */
|
|
case 0x0e8: /* GENERAL_PURPOSE15 */
|
|
case 0x0ec: /* GENERAL_PURPOSE16 */
|
|
case 0x0f0: /* GENERAL_PURPOSE17 */
|
|
case 0x0f4: /* GENERAL_PURPOSE18 */
|
|
case 0x0f8: /* GENERAL_PURPOSE19 */
|
|
case 0x0fc: /* GENERAL_PURPOSE20 */
|
|
return s->scratch[(offset - 0xb0) >> 2];
|
|
|
|
case 0x140: /* CM_CLKSEL_MPU */
|
|
return s->clksel[0];
|
|
case 0x148: /* CM_CLKSTCTRL_MPU */
|
|
return s->clkctrl[0];
|
|
|
|
case 0x158: /* RM_RSTST_MPU */
|
|
return s->rst[0];
|
|
case 0x1c8: /* PM_WKDEP_MPU */
|
|
return s->wkup[0];
|
|
case 0x1d4: /* PM_EVGENCTRL_MPU */
|
|
return s->ev;
|
|
case 0x1d8: /* PM_EVEGENONTIM_MPU */
|
|
return s->evtime[0];
|
|
case 0x1dc: /* PM_EVEGENOFFTIM_MPU */
|
|
return s->evtime[1];
|
|
case 0x1e0: /* PM_PWSTCTRL_MPU */
|
|
return s->power[0];
|
|
case 0x1e4: /* PM_PWSTST_MPU */
|
|
return 0;
|
|
|
|
case 0x200: /* CM_FCLKEN1_CORE */
|
|
return s->clken[0];
|
|
case 0x204: /* CM_FCLKEN2_CORE */
|
|
return s->clken[1];
|
|
case 0x210: /* CM_ICLKEN1_CORE */
|
|
return s->clken[2];
|
|
case 0x214: /* CM_ICLKEN2_CORE */
|
|
return s->clken[3];
|
|
case 0x21c: /* CM_ICLKEN4_CORE */
|
|
return s->clken[4];
|
|
|
|
case 0x220: /* CM_IDLEST1_CORE */
|
|
/* TODO: check the actual iclk status */
|
|
return 0x7ffffff9;
|
|
case 0x224: /* CM_IDLEST2_CORE */
|
|
/* TODO: check the actual iclk status */
|
|
return 0x00000007;
|
|
case 0x22c: /* CM_IDLEST4_CORE */
|
|
/* TODO: check the actual iclk status */
|
|
return 0x0000001f;
|
|
|
|
case 0x230: /* CM_AUTOIDLE1_CORE */
|
|
return s->clkidle[0];
|
|
case 0x234: /* CM_AUTOIDLE2_CORE */
|
|
return s->clkidle[1];
|
|
case 0x238: /* CM_AUTOIDLE3_CORE */
|
|
return s->clkidle[2];
|
|
case 0x23c: /* CM_AUTOIDLE4_CORE */
|
|
return s->clkidle[3];
|
|
|
|
case 0x240: /* CM_CLKSEL1_CORE */
|
|
return s->clksel[1];
|
|
case 0x244: /* CM_CLKSEL2_CORE */
|
|
return s->clksel[2];
|
|
|
|
case 0x248: /* CM_CLKSTCTRL_CORE */
|
|
return s->clkctrl[1];
|
|
|
|
case 0x2a0: /* PM_WKEN1_CORE */
|
|
return s->wken[0];
|
|
case 0x2a4: /* PM_WKEN2_CORE */
|
|
return s->wken[1];
|
|
|
|
case 0x2b0: /* PM_WKST1_CORE */
|
|
return s->wkst[0];
|
|
case 0x2b4: /* PM_WKST2_CORE */
|
|
return s->wkst[1];
|
|
case 0x2c8: /* PM_WKDEP_CORE */
|
|
return 0x1e;
|
|
|
|
case 0x2e0: /* PM_PWSTCTRL_CORE */
|
|
return s->power[1];
|
|
case 0x2e4: /* PM_PWSTST_CORE */
|
|
return 0x000030 | (s->power[1] & 0xfc00);
|
|
|
|
case 0x300: /* CM_FCLKEN_GFX */
|
|
return s->clken[5];
|
|
case 0x310: /* CM_ICLKEN_GFX */
|
|
return s->clken[6];
|
|
case 0x320: /* CM_IDLEST_GFX */
|
|
/* TODO: check the actual iclk status */
|
|
return 0x00000001;
|
|
case 0x340: /* CM_CLKSEL_GFX */
|
|
return s->clksel[3];
|
|
case 0x348: /* CM_CLKSTCTRL_GFX */
|
|
return s->clkctrl[2];
|
|
case 0x350: /* RM_RSTCTRL_GFX */
|
|
return s->rstctrl[0];
|
|
case 0x358: /* RM_RSTST_GFX */
|
|
return s->rst[1];
|
|
case 0x3c8: /* PM_WKDEP_GFX */
|
|
return s->wkup[1];
|
|
|
|
case 0x3e0: /* PM_PWSTCTRL_GFX */
|
|
return s->power[2];
|
|
case 0x3e4: /* PM_PWSTST_GFX */
|
|
return s->power[2] & 3;
|
|
|
|
case 0x400: /* CM_FCLKEN_WKUP */
|
|
return s->clken[7];
|
|
case 0x410: /* CM_ICLKEN_WKUP */
|
|
return s->clken[8];
|
|
case 0x420: /* CM_IDLEST_WKUP */
|
|
/* TODO: check the actual iclk status */
|
|
return 0x0000003f;
|
|
case 0x430: /* CM_AUTOIDLE_WKUP */
|
|
return s->clkidle[4];
|
|
case 0x440: /* CM_CLKSEL_WKUP */
|
|
return s->clksel[4];
|
|
case 0x450: /* RM_RSTCTRL_WKUP */
|
|
return 0;
|
|
case 0x454: /* RM_RSTTIME_WKUP */
|
|
return s->rsttime_wkup;
|
|
case 0x458: /* RM_RSTST_WKUP */
|
|
return s->rst[2];
|
|
case 0x4a0: /* PM_WKEN_WKUP */
|
|
return s->wken[2];
|
|
case 0x4b0: /* PM_WKST_WKUP */
|
|
return s->wkst[2];
|
|
|
|
case 0x500: /* CM_CLKEN_PLL */
|
|
return s->clken[9];
|
|
case 0x520: /* CM_IDLEST_CKGEN */
|
|
/* Core uses 32-kHz clock */
|
|
if (!(s->clksel[6] & 3))
|
|
return 0x00000377;
|
|
/* DPLL not in lock mode, core uses ref_clk */
|
|
if ((s->clken[9] & 3) != 3)
|
|
return 0x00000375;
|
|
/* Core uses DPLL */
|
|
return 0x00000376;
|
|
case 0x530: /* CM_AUTOIDLE_PLL */
|
|
return s->clkidle[5];
|
|
case 0x540: /* CM_CLKSEL1_PLL */
|
|
return s->clksel[5];
|
|
case 0x544: /* CM_CLKSEL2_PLL */
|
|
return s->clksel[6];
|
|
|
|
case 0x800: /* CM_FCLKEN_DSP */
|
|
return s->clken[10];
|
|
case 0x810: /* CM_ICLKEN_DSP */
|
|
return s->clken[11];
|
|
case 0x820: /* CM_IDLEST_DSP */
|
|
/* TODO: check the actual iclk status */
|
|
return 0x00000103;
|
|
case 0x830: /* CM_AUTOIDLE_DSP */
|
|
return s->clkidle[6];
|
|
case 0x840: /* CM_CLKSEL_DSP */
|
|
return s->clksel[7];
|
|
case 0x848: /* CM_CLKSTCTRL_DSP */
|
|
return s->clkctrl[3];
|
|
case 0x850: /* RM_RSTCTRL_DSP */
|
|
return 0;
|
|
case 0x858: /* RM_RSTST_DSP */
|
|
return s->rst[3];
|
|
case 0x8c8: /* PM_WKDEP_DSP */
|
|
return s->wkup[2];
|
|
case 0x8e0: /* PM_PWSTCTRL_DSP */
|
|
return s->power[3];
|
|
case 0x8e4: /* PM_PWSTST_DSP */
|
|
return 0x008030 | (s->power[3] & 0x3003);
|
|
|
|
case 0x8f0: /* PRCM_IRQSTATUS_DSP */
|
|
return s->irqst[1];
|
|
case 0x8f4: /* PRCM_IRQENABLE_DSP */
|
|
return s->irqen[1];
|
|
|
|
case 0x8f8: /* PRCM_IRQSTATUS_IVA */
|
|
return s->irqst[2];
|
|
case 0x8fc: /* PRCM_IRQENABLE_IVA */
|
|
return s->irqen[2];
|
|
}
|
|
|
|
OMAP_BAD_REG(addr);
|
|
return 0;
|
|
}
|
|
|
|
static void omap_prcm_write(void *opaque, target_phys_addr_t addr,
|
|
uint32_t value)
|
|
{
|
|
struct omap_prcm_s *s = (struct omap_prcm_s *) opaque;
|
|
int offset = addr - s->base;
|
|
|
|
switch (offset) {
|
|
case 0x000: /* PRCM_REVISION */
|
|
case 0x054: /* PRCM_VOLTST */
|
|
case 0x084: /* PRCM_CLKCFG_STATUS */
|
|
case 0x1e4: /* PM_PWSTST_MPU */
|
|
case 0x220: /* CM_IDLEST1_CORE */
|
|
case 0x224: /* CM_IDLEST2_CORE */
|
|
case 0x22c: /* CM_IDLEST4_CORE */
|
|
case 0x2c8: /* PM_WKDEP_CORE */
|
|
case 0x2e4: /* PM_PWSTST_CORE */
|
|
case 0x320: /* CM_IDLEST_GFX */
|
|
case 0x3e4: /* PM_PWSTST_GFX */
|
|
case 0x420: /* CM_IDLEST_WKUP */
|
|
case 0x520: /* CM_IDLEST_CKGEN */
|
|
case 0x820: /* CM_IDLEST_DSP */
|
|
case 0x8e4: /* PM_PWSTST_DSP */
|
|
OMAP_RO_REG(addr);
|
|
return;
|
|
|
|
case 0x010: /* PRCM_SYSCONFIG */
|
|
s->sysconfig = value & 1;
|
|
break;
|
|
|
|
case 0x018: /* PRCM_IRQSTATUS_MPU */
|
|
s->irqst[0] &= ~value;
|
|
omap_prcm_int_update(s, 0);
|
|
break;
|
|
case 0x01c: /* PRCM_IRQENABLE_MPU */
|
|
s->irqen[0] = value & 0x3f;
|
|
omap_prcm_int_update(s, 0);
|
|
break;
|
|
|
|
case 0x050: /* PRCM_VOLTCTRL */
|
|
s->voltctrl = value & 0xf1c3;
|
|
break;
|
|
|
|
case 0x060: /* PRCM_CLKSRC_CTRL */
|
|
s->clksrc[0] = value & 0xdb;
|
|
/* TODO update clocks */
|
|
break;
|
|
|
|
case 0x070: /* PRCM_CLKOUT_CTRL */
|
|
s->clkout[0] = value & 0xbbbb;
|
|
/* TODO update clocks */
|
|
break;
|
|
|
|
case 0x078: /* PRCM_CLKEMUL_CTRL */
|
|
s->clkemul[0] = value & 1;
|
|
/* TODO update clocks */
|
|
break;
|
|
|
|
case 0x080: /* PRCM_CLKCFG_CTRL */
|
|
break;
|
|
|
|
case 0x090: /* PRCM_VOLTSETUP */
|
|
s->setuptime[0] = value & 0xffff;
|
|
break;
|
|
case 0x094: /* PRCM_CLKSSETUP */
|
|
s->setuptime[1] = value & 0xffff;
|
|
break;
|
|
|
|
case 0x098: /* PRCM_POLCTRL */
|
|
s->clkpol[0] = value & 0x701;
|
|
break;
|
|
|
|
case 0x0b0: /* GENERAL_PURPOSE1 */
|
|
case 0x0b4: /* GENERAL_PURPOSE2 */
|
|
case 0x0b8: /* GENERAL_PURPOSE3 */
|
|
case 0x0bc: /* GENERAL_PURPOSE4 */
|
|
case 0x0c0: /* GENERAL_PURPOSE5 */
|
|
case 0x0c4: /* GENERAL_PURPOSE6 */
|
|
case 0x0c8: /* GENERAL_PURPOSE7 */
|
|
case 0x0cc: /* GENERAL_PURPOSE8 */
|
|
case 0x0d0: /* GENERAL_PURPOSE9 */
|
|
case 0x0d4: /* GENERAL_PURPOSE10 */
|
|
case 0x0d8: /* GENERAL_PURPOSE11 */
|
|
case 0x0dc: /* GENERAL_PURPOSE12 */
|
|
case 0x0e0: /* GENERAL_PURPOSE13 */
|
|
case 0x0e4: /* GENERAL_PURPOSE14 */
|
|
case 0x0e8: /* GENERAL_PURPOSE15 */
|
|
case 0x0ec: /* GENERAL_PURPOSE16 */
|
|
case 0x0f0: /* GENERAL_PURPOSE17 */
|
|
case 0x0f4: /* GENERAL_PURPOSE18 */
|
|
case 0x0f8: /* GENERAL_PURPOSE19 */
|
|
case 0x0fc: /* GENERAL_PURPOSE20 */
|
|
s->scratch[(offset - 0xb0) >> 2] = value;
|
|
break;
|
|
|
|
case 0x140: /* CM_CLKSEL_MPU */
|
|
s->clksel[0] = value & 0x1f;
|
|
/* TODO update clocks */
|
|
break;
|
|
case 0x148: /* CM_CLKSTCTRL_MPU */
|
|
s->clkctrl[0] = value & 0x1f;
|
|
break;
|
|
|
|
case 0x158: /* RM_RSTST_MPU */
|
|
s->rst[0] &= ~value;
|
|
break;
|
|
case 0x1c8: /* PM_WKDEP_MPU */
|
|
s->wkup[0] = value & 0x15;
|
|
break;
|
|
|
|
case 0x1d4: /* PM_EVGENCTRL_MPU */
|
|
s->ev = value & 0x1f;
|
|
break;
|
|
case 0x1d8: /* PM_EVEGENONTIM_MPU */
|
|
s->evtime[0] = value;
|
|
break;
|
|
case 0x1dc: /* PM_EVEGENOFFTIM_MPU */
|
|
s->evtime[1] = value;
|
|
break;
|
|
|
|
case 0x1e0: /* PM_PWSTCTRL_MPU */
|
|
s->power[0] = value & 0xc0f;
|
|
break;
|
|
|
|
case 0x200: /* CM_FCLKEN1_CORE */
|
|
s->clken[0] = value & 0xbfffffff;
|
|
/* TODO update clocks */
|
|
break;
|
|
case 0x204: /* CM_FCLKEN2_CORE */
|
|
s->clken[1] = value & 0x00000007;
|
|
/* TODO update clocks */
|
|
break;
|
|
case 0x210: /* CM_ICLKEN1_CORE */
|
|
s->clken[2] = value & 0xfffffff9;
|
|
/* TODO update clocks */
|
|
break;
|
|
case 0x214: /* CM_ICLKEN2_CORE */
|
|
s->clken[3] = value & 0x00000007;
|
|
/* TODO update clocks */
|
|
break;
|
|
case 0x21c: /* CM_ICLKEN4_CORE */
|
|
s->clken[4] = value & 0x0000001f;
|
|
/* TODO update clocks */
|
|
break;
|
|
|
|
case 0x230: /* CM_AUTOIDLE1_CORE */
|
|
s->clkidle[0] = value & 0xfffffff9;
|
|
/* TODO update clocks */
|
|
break;
|
|
case 0x234: /* CM_AUTOIDLE2_CORE */
|
|
s->clkidle[1] = value & 0x00000007;
|
|
/* TODO update clocks */
|
|
break;
|
|
case 0x238: /* CM_AUTOIDLE3_CORE */
|
|
s->clkidle[2] = value & 0x00000007;
|
|
/* TODO update clocks */
|
|
break;
|
|
case 0x23c: /* CM_AUTOIDLE4_CORE */
|
|
s->clkidle[3] = value & 0x0000001f;
|
|
/* TODO update clocks */
|
|
break;
|
|
|
|
case 0x240: /* CM_CLKSEL1_CORE */
|
|
s->clksel[1] = value & 0x0fffbf7f;
|
|
/* TODO update clocks */
|
|
break;
|
|
|
|
case 0x244: /* CM_CLKSEL2_CORE */
|
|
s->clksel[2] = value & 0x00fffffc;
|
|
/* TODO update clocks */
|
|
break;
|
|
|
|
case 0x248: /* CM_CLKSTCTRL_CORE */
|
|
s->clkctrl[1] = value & 0x7;
|
|
break;
|
|
|
|
case 0x2a0: /* PM_WKEN1_CORE */
|
|
s->wken[0] = value & 0x04667ff8;
|
|
break;
|
|
case 0x2a4: /* PM_WKEN2_CORE */
|
|
s->wken[1] = value & 0x00000005;
|
|
break;
|
|
|
|
case 0x2b0: /* PM_WKST1_CORE */
|
|
s->wkst[0] &= ~value;
|
|
break;
|
|
case 0x2b4: /* PM_WKST2_CORE */
|
|
s->wkst[1] &= ~value;
|
|
break;
|
|
|
|
case 0x2e0: /* PM_PWSTCTRL_CORE */
|
|
s->power[1] = (value & 0x00fc3f) | (1 << 2);
|
|
break;
|
|
|
|
case 0x300: /* CM_FCLKEN_GFX */
|
|
s->clken[5] = value & 6;
|
|
/* TODO update clocks */
|
|
break;
|
|
case 0x310: /* CM_ICLKEN_GFX */
|
|
s->clken[6] = value & 1;
|
|
/* TODO update clocks */
|
|
break;
|
|
case 0x340: /* CM_CLKSEL_GFX */
|
|
s->clksel[3] = value & 7;
|
|
/* TODO update clocks */
|
|
break;
|
|
case 0x348: /* CM_CLKSTCTRL_GFX */
|
|
s->clkctrl[2] = value & 1;
|
|
break;
|
|
case 0x350: /* RM_RSTCTRL_GFX */
|
|
s->rstctrl[0] = value & 1;
|
|
/* TODO: reset */
|
|
break;
|
|
case 0x358: /* RM_RSTST_GFX */
|
|
s->rst[1] &= ~value;
|
|
break;
|
|
case 0x3c8: /* PM_WKDEP_GFX */
|
|
s->wkup[1] = value & 0x13;
|
|
break;
|
|
case 0x3e0: /* PM_PWSTCTRL_GFX */
|
|
s->power[2] = (value & 0x00c0f) | (3 << 2);
|
|
break;
|
|
|
|
case 0x400: /* CM_FCLKEN_WKUP */
|
|
s->clken[7] = value & 0xd;
|
|
/* TODO update clocks */
|
|
break;
|
|
case 0x410: /* CM_ICLKEN_WKUP */
|
|
s->clken[8] = value & 0x3f;
|
|
/* TODO update clocks */
|
|
break;
|
|
case 0x430: /* CM_AUTOIDLE_WKUP */
|
|
s->clkidle[4] = value & 0x0000003f;
|
|
/* TODO update clocks */
|
|
break;
|
|
case 0x440: /* CM_CLKSEL_WKUP */
|
|
s->clksel[4] = value & 3;
|
|
/* TODO update clocks */
|
|
break;
|
|
case 0x450: /* RM_RSTCTRL_WKUP */
|
|
/* TODO: reset */
|
|
if (value & 2)
|
|
qemu_system_reset_request();
|
|
break;
|
|
case 0x454: /* RM_RSTTIME_WKUP */
|
|
s->rsttime_wkup = value & 0x1fff;
|
|
break;
|
|
case 0x458: /* RM_RSTST_WKUP */
|
|
s->rst[2] &= ~value;
|
|
break;
|
|
case 0x4a0: /* PM_WKEN_WKUP */
|
|
s->wken[2] = value & 0x00000005;
|
|
break;
|
|
case 0x4b0: /* PM_WKST_WKUP */
|
|
s->wkst[2] &= ~value;
|
|
break;
|
|
|
|
case 0x500: /* CM_CLKEN_PLL */
|
|
s->clken[9] = value & 0xcf;
|
|
/* TODO update clocks */
|
|
break;
|
|
case 0x530: /* CM_AUTOIDLE_PLL */
|
|
s->clkidle[5] = value & 0x000000cf;
|
|
/* TODO update clocks */
|
|
break;
|
|
case 0x540: /* CM_CLKSEL1_PLL */
|
|
s->clksel[5] = value & 0x03bfff28;
|
|
/* TODO update clocks */
|
|
break;
|
|
case 0x544: /* CM_CLKSEL2_PLL */
|
|
s->clksel[6] = value & 3;
|
|
/* TODO update clocks */
|
|
break;
|
|
|
|
case 0x800: /* CM_FCLKEN_DSP */
|
|
s->clken[10] = value & 0x501;
|
|
/* TODO update clocks */
|
|
break;
|
|
case 0x810: /* CM_ICLKEN_DSP */
|
|
s->clken[11] = value & 0x2;
|
|
/* TODO update clocks */
|
|
break;
|
|
case 0x830: /* CM_AUTOIDLE_DSP */
|
|
s->clkidle[6] = value & 0x2;
|
|
/* TODO update clocks */
|
|
break;
|
|
case 0x840: /* CM_CLKSEL_DSP */
|
|
s->clksel[7] = value & 0x3fff;
|
|
/* TODO update clocks */
|
|
break;
|
|
case 0x848: /* CM_CLKSTCTRL_DSP */
|
|
s->clkctrl[3] = value & 0x101;
|
|
break;
|
|
case 0x850: /* RM_RSTCTRL_DSP */
|
|
/* TODO: reset */
|
|
break;
|
|
case 0x858: /* RM_RSTST_DSP */
|
|
s->rst[3] &= ~value;
|
|
break;
|
|
case 0x8c8: /* PM_WKDEP_DSP */
|
|
s->wkup[2] = value & 0x13;
|
|
break;
|
|
case 0x8e0: /* PM_PWSTCTRL_DSP */
|
|
s->power[3] = (value & 0x03017) | (3 << 2);
|
|
break;
|
|
|
|
case 0x8f0: /* PRCM_IRQSTATUS_DSP */
|
|
s->irqst[1] &= ~value;
|
|
omap_prcm_int_update(s, 1);
|
|
break;
|
|
case 0x8f4: /* PRCM_IRQENABLE_DSP */
|
|
s->irqen[1] = value & 0x7;
|
|
omap_prcm_int_update(s, 1);
|
|
break;
|
|
|
|
case 0x8f8: /* PRCM_IRQSTATUS_IVA */
|
|
s->irqst[2] &= ~value;
|
|
omap_prcm_int_update(s, 2);
|
|
break;
|
|
case 0x8fc: /* PRCM_IRQENABLE_IVA */
|
|
s->irqen[2] = value & 0x7;
|
|
omap_prcm_int_update(s, 2);
|
|
break;
|
|
|
|
default:
|
|
OMAP_BAD_REG(addr);
|
|
return;
|
|
}
|
|
}
|
|
|
|
static CPUReadMemoryFunc *omap_prcm_readfn[] = {
|
|
omap_badwidth_read32,
|
|
omap_badwidth_read32,
|
|
omap_prcm_read,
|
|
};
|
|
|
|
static CPUWriteMemoryFunc *omap_prcm_writefn[] = {
|
|
omap_badwidth_write32,
|
|
omap_badwidth_write32,
|
|
omap_prcm_write,
|
|
};
|
|
|
|
static void omap_prcm_reset(struct omap_prcm_s *s)
|
|
{
|
|
s->sysconfig = 0;
|
|
s->irqst[0] = 0;
|
|
s->irqst[1] = 0;
|
|
s->irqst[2] = 0;
|
|
s->irqen[0] = 0;
|
|
s->irqen[1] = 0;
|
|
s->irqen[2] = 0;
|
|
s->voltctrl = 0x1040;
|
|
s->ev = 0x14;
|
|
s->evtime[0] = 0;
|
|
s->evtime[1] = 0;
|
|
s->clkctrl[0] = 0;
|
|
s->clkctrl[1] = 0;
|
|
s->clkctrl[2] = 0;
|
|
s->clkctrl[3] = 0;
|
|
s->clken[1] = 7;
|
|
s->clken[3] = 7;
|
|
s->clken[4] = 0;
|
|
s->clken[5] = 0;
|
|
s->clken[6] = 0;
|
|
s->clken[7] = 0xc;
|
|
s->clken[8] = 0x3e;
|
|
s->clken[9] = 0x0d;
|
|
s->clken[10] = 0;
|
|
s->clken[11] = 0;
|
|
s->clkidle[0] = 0;
|
|
s->clkidle[2] = 7;
|
|
s->clkidle[3] = 0;
|
|
s->clkidle[4] = 0;
|
|
s->clkidle[5] = 0x0c;
|
|
s->clkidle[6] = 0;
|
|
s->clksel[0] = 0x01;
|
|
s->clksel[1] = 0x02100121;
|
|
s->clksel[2] = 0x00000000;
|
|
s->clksel[3] = 0x01;
|
|
s->clksel[4] = 0;
|
|
s->clksel[7] = 0x0121;
|
|
s->wkup[0] = 0x15;
|
|
s->wkup[1] = 0x13;
|
|
s->wkup[2] = 0x13;
|
|
s->wken[0] = 0x04667ff8;
|
|
s->wken[1] = 0x00000005;
|
|
s->wken[2] = 5;
|
|
s->wkst[0] = 0;
|
|
s->wkst[1] = 0;
|
|
s->wkst[2] = 0;
|
|
s->power[0] = 0x00c;
|
|
s->power[1] = 4;
|
|
s->power[2] = 0x0000c;
|
|
s->power[3] = 0x14;
|
|
s->rstctrl[0] = 1;
|
|
s->rst[3] = 1;
|
|
}
|
|
|
|
static void omap_prcm_coldreset(struct omap_prcm_s *s)
|
|
{
|
|
s->setuptime[0] = 0;
|
|
s->setuptime[1] = 0;
|
|
memset(&s->scratch, 0, sizeof(s->scratch));
|
|
s->rst[0] = 0x01;
|
|
s->rst[1] = 0x00;
|
|
s->rst[2] = 0x01;
|
|
s->clken[0] = 0;
|
|
s->clken[2] = 0;
|
|
s->clkidle[1] = 0;
|
|
s->clksel[5] = 0;
|
|
s->clksel[6] = 2;
|
|
s->clksrc[0] = 0x43;
|
|
s->clkout[0] = 0x0303;
|
|
s->clkemul[0] = 0;
|
|
s->clkpol[0] = 0x100;
|
|
s->rsttime_wkup = 0x1002;
|
|
|
|
omap_prcm_reset(s);
|
|
}
|
|
|
|
struct omap_prcm_s *omap_prcm_init(struct omap_target_agent_s *ta,
|
|
qemu_irq mpu_int, qemu_irq dsp_int, qemu_irq iva_int,
|
|
struct omap_mpu_state_s *mpu)
|
|
{
|
|
int iomemtype;
|
|
struct omap_prcm_s *s = (struct omap_prcm_s *)
|
|
qemu_mallocz(sizeof(struct omap_prcm_s));
|
|
|
|
s->irq[0] = mpu_int;
|
|
s->irq[1] = dsp_int;
|
|
s->irq[2] = iva_int;
|
|
s->mpu = mpu;
|
|
omap_prcm_coldreset(s);
|
|
|
|
iomemtype = l4_register_io_memory(0, omap_prcm_readfn,
|
|
omap_prcm_writefn, s);
|
|
s->base = omap_l4_attach(ta, 0, iomemtype);
|
|
omap_l4_attach(ta, 1, iomemtype);
|
|
|
|
return s;
|
|
}
|
|
|
|
/* System and Pinout control */
|
|
struct omap_sysctl_s {
|
|
target_phys_addr_t base;
|
|
struct omap_mpu_state_s *mpu;
|
|
|
|
uint32_t sysconfig;
|
|
uint32_t devconfig;
|
|
uint32_t psaconfig;
|
|
uint32_t padconf[0x45];
|
|
uint8_t obs;
|
|
uint32_t msuspendmux[5];
|
|
};
|
|
|
|
static uint32_t omap_sysctl_read(void *opaque, target_phys_addr_t addr)
|
|
{
|
|
struct omap_sysctl_s *s = (struct omap_sysctl_s *) opaque;
|
|
int offset = addr - s->base;
|
|
|
|
switch (offset) {
|
|
case 0x000: /* CONTROL_REVISION */
|
|
return 0x20;
|
|
|
|
case 0x010: /* CONTROL_SYSCONFIG */
|
|
return s->sysconfig;
|
|
|
|
case 0x030 ... 0x140: /* CONTROL_PADCONF - only used in the POP */
|
|
return s->padconf[(offset - 0x30) >> 2];
|
|
|
|
case 0x270: /* CONTROL_DEBOBS */
|
|
return s->obs;
|
|
|
|
case 0x274: /* CONTROL_DEVCONF */
|
|
return s->devconfig;
|
|
|
|
case 0x28c: /* CONTROL_EMU_SUPPORT */
|
|
return 0;
|
|
|
|
case 0x290: /* CONTROL_MSUSPENDMUX_0 */
|
|
return s->msuspendmux[0];
|
|
case 0x294: /* CONTROL_MSUSPENDMUX_1 */
|
|
return s->msuspendmux[1];
|
|
case 0x298: /* CONTROL_MSUSPENDMUX_2 */
|
|
return s->msuspendmux[2];
|
|
case 0x29c: /* CONTROL_MSUSPENDMUX_3 */
|
|
return s->msuspendmux[3];
|
|
case 0x2a0: /* CONTROL_MSUSPENDMUX_4 */
|
|
return s->msuspendmux[4];
|
|
case 0x2a4: /* CONTROL_MSUSPENDMUX_5 */
|
|
return 0;
|
|
|
|
case 0x2b8: /* CONTROL_PSA_CTRL */
|
|
return s->psaconfig;
|
|
case 0x2bc: /* CONTROL_PSA_CMD */
|
|
case 0x2c0: /* CONTROL_PSA_VALUE */
|
|
return 0;
|
|
|
|
case 0x2b0: /* CONTROL_SEC_CTRL */
|
|
return 0x800000f1;
|
|
case 0x2d0: /* CONTROL_SEC_EMU */
|
|
return 0x80000015;
|
|
case 0x2d4: /* CONTROL_SEC_TAP */
|
|
return 0x8000007f;
|
|
case 0x2b4: /* CONTROL_SEC_TEST */
|
|
case 0x2f0: /* CONTROL_SEC_STATUS */
|
|
case 0x2f4: /* CONTROL_SEC_ERR_STATUS */
|
|
/* Secure mode is not present on general-pusrpose device. Outside
|
|
* secure mode these values cannot be read or written. */
|
|
return 0;
|
|
|
|
case 0x2d8: /* CONTROL_OCM_RAM_PERM */
|
|
return 0xff;
|
|
case 0x2dc: /* CONTROL_OCM_PUB_RAM_ADD */
|
|
case 0x2e0: /* CONTROL_EXT_SEC_RAM_START_ADD */
|
|
case 0x2e4: /* CONTROL_EXT_SEC_RAM_STOP_ADD */
|
|
/* No secure mode so no Extended Secure RAM present. */
|
|
return 0;
|
|
|
|
case 0x2f8: /* CONTROL_STATUS */
|
|
/* Device Type => General-purpose */
|
|
return 0x0300;
|
|
case 0x2fc: /* CONTROL_GENERAL_PURPOSE_STATUS */
|
|
|
|
case 0x300: /* CONTROL_RPUB_KEY_H_0 */
|
|
case 0x304: /* CONTROL_RPUB_KEY_H_1 */
|
|
case 0x308: /* CONTROL_RPUB_KEY_H_2 */
|
|
case 0x30c: /* CONTROL_RPUB_KEY_H_3 */
|
|
return 0xdecafbad;
|
|
|
|
case 0x310: /* CONTROL_RAND_KEY_0 */
|
|
case 0x314: /* CONTROL_RAND_KEY_1 */
|
|
case 0x318: /* CONTROL_RAND_KEY_2 */
|
|
case 0x31c: /* CONTROL_RAND_KEY_3 */
|
|
case 0x320: /* CONTROL_CUST_KEY_0 */
|
|
case 0x324: /* CONTROL_CUST_KEY_1 */
|
|
case 0x330: /* CONTROL_TEST_KEY_0 */
|
|
case 0x334: /* CONTROL_TEST_KEY_1 */
|
|
case 0x338: /* CONTROL_TEST_KEY_2 */
|
|
case 0x33c: /* CONTROL_TEST_KEY_3 */
|
|
case 0x340: /* CONTROL_TEST_KEY_4 */
|
|
case 0x344: /* CONTROL_TEST_KEY_5 */
|
|
case 0x348: /* CONTROL_TEST_KEY_6 */
|
|
case 0x34c: /* CONTROL_TEST_KEY_7 */
|
|
case 0x350: /* CONTROL_TEST_KEY_8 */
|
|
case 0x354: /* CONTROL_TEST_KEY_9 */
|
|
/* Can only be accessed in secure mode and when C_FieldAccEnable
|
|
* bit is set in CONTROL_SEC_CTRL.
|
|
* TODO: otherwise an interconnect access error is generated. */
|
|
return 0;
|
|
}
|
|
|
|
OMAP_BAD_REG(addr);
|
|
return 0;
|
|
}
|
|
|
|
static void omap_sysctl_write(void *opaque, target_phys_addr_t addr,
|
|
uint32_t value)
|
|
{
|
|
struct omap_sysctl_s *s = (struct omap_sysctl_s *) opaque;
|
|
int offset = addr - s->base;
|
|
|
|
switch (offset) {
|
|
case 0x000: /* CONTROL_REVISION */
|
|
case 0x2a4: /* CONTROL_MSUSPENDMUX_5 */
|
|
case 0x2c0: /* CONTROL_PSA_VALUE */
|
|
case 0x2f8: /* CONTROL_STATUS */
|
|
case 0x2fc: /* CONTROL_GENERAL_PURPOSE_STATUS */
|
|
case 0x300: /* CONTROL_RPUB_KEY_H_0 */
|
|
case 0x304: /* CONTROL_RPUB_KEY_H_1 */
|
|
case 0x308: /* CONTROL_RPUB_KEY_H_2 */
|
|
case 0x30c: /* CONTROL_RPUB_KEY_H_3 */
|
|
case 0x310: /* CONTROL_RAND_KEY_0 */
|
|
case 0x314: /* CONTROL_RAND_KEY_1 */
|
|
case 0x318: /* CONTROL_RAND_KEY_2 */
|
|
case 0x31c: /* CONTROL_RAND_KEY_3 */
|
|
case 0x320: /* CONTROL_CUST_KEY_0 */
|
|
case 0x324: /* CONTROL_CUST_KEY_1 */
|
|
case 0x330: /* CONTROL_TEST_KEY_0 */
|
|
case 0x334: /* CONTROL_TEST_KEY_1 */
|
|
case 0x338: /* CONTROL_TEST_KEY_2 */
|
|
case 0x33c: /* CONTROL_TEST_KEY_3 */
|
|
case 0x340: /* CONTROL_TEST_KEY_4 */
|
|
case 0x344: /* CONTROL_TEST_KEY_5 */
|
|
case 0x348: /* CONTROL_TEST_KEY_6 */
|
|
case 0x34c: /* CONTROL_TEST_KEY_7 */
|
|
case 0x350: /* CONTROL_TEST_KEY_8 */
|
|
case 0x354: /* CONTROL_TEST_KEY_9 */
|
|
OMAP_RO_REG(addr);
|
|
return;
|
|
|
|
case 0x010: /* CONTROL_SYSCONFIG */
|
|
s->sysconfig = value & 0x1e;
|
|
break;
|
|
|
|
case 0x030 ... 0x140: /* CONTROL_PADCONF - only used in the POP */
|
|
/* XXX: should check constant bits */
|
|
s->padconf[(offset - 0x30) >> 2] = value & 0x1f1f1f1f;
|
|
break;
|
|
|
|
case 0x270: /* CONTROL_DEBOBS */
|
|
s->obs = value & 0xff;
|
|
break;
|
|
|
|
case 0x274: /* CONTROL_DEVCONF */
|
|
s->devconfig = value & 0xffffc7ff;
|
|
break;
|
|
|
|
case 0x28c: /* CONTROL_EMU_SUPPORT */
|
|
break;
|
|
|
|
case 0x290: /* CONTROL_MSUSPENDMUX_0 */
|
|
s->msuspendmux[0] = value & 0x3fffffff;
|
|
break;
|
|
case 0x294: /* CONTROL_MSUSPENDMUX_1 */
|
|
s->msuspendmux[1] = value & 0x3fffffff;
|
|
break;
|
|
case 0x298: /* CONTROL_MSUSPENDMUX_2 */
|
|
s->msuspendmux[2] = value & 0x3fffffff;
|
|
break;
|
|
case 0x29c: /* CONTROL_MSUSPENDMUX_3 */
|
|
s->msuspendmux[3] = value & 0x3fffffff;
|
|
break;
|
|
case 0x2a0: /* CONTROL_MSUSPENDMUX_4 */
|
|
s->msuspendmux[4] = value & 0x3fffffff;
|
|
break;
|
|
|
|
case 0x2b8: /* CONTROL_PSA_CTRL */
|
|
s->psaconfig = value & 0x1c;
|
|
s->psaconfig |= (value & 0x20) ? 2 : 1;
|
|
break;
|
|
case 0x2bc: /* CONTROL_PSA_CMD */
|
|
break;
|
|
|
|
case 0x2b0: /* CONTROL_SEC_CTRL */
|
|
case 0x2b4: /* CONTROL_SEC_TEST */
|
|
case 0x2d0: /* CONTROL_SEC_EMU */
|
|
case 0x2d4: /* CONTROL_SEC_TAP */
|
|
case 0x2d8: /* CONTROL_OCM_RAM_PERM */
|
|
case 0x2dc: /* CONTROL_OCM_PUB_RAM_ADD */
|
|
case 0x2e0: /* CONTROL_EXT_SEC_RAM_START_ADD */
|
|
case 0x2e4: /* CONTROL_EXT_SEC_RAM_STOP_ADD */
|
|
case 0x2f0: /* CONTROL_SEC_STATUS */
|
|
case 0x2f4: /* CONTROL_SEC_ERR_STATUS */
|
|
break;
|
|
|
|
default:
|
|
OMAP_BAD_REG(addr);
|
|
return;
|
|
}
|
|
}
|
|
|
|
static CPUReadMemoryFunc *omap_sysctl_readfn[] = {
|
|
omap_badwidth_read32, /* TODO */
|
|
omap_badwidth_read32, /* TODO */
|
|
omap_sysctl_read,
|
|
};
|
|
|
|
static CPUWriteMemoryFunc *omap_sysctl_writefn[] = {
|
|
omap_badwidth_write32, /* TODO */
|
|
omap_badwidth_write32, /* TODO */
|
|
omap_sysctl_write,
|
|
};
|
|
|
|
static void omap_sysctl_reset(struct omap_sysctl_s *s)
|
|
{
|
|
/* (power-on reset) */
|
|
s->sysconfig = 0;
|
|
s->obs = 0;
|
|
s->devconfig = 0x0c000000;
|
|
s->msuspendmux[0] = 0x00000000;
|
|
s->msuspendmux[1] = 0x00000000;
|
|
s->msuspendmux[2] = 0x00000000;
|
|
s->msuspendmux[3] = 0x00000000;
|
|
s->msuspendmux[4] = 0x00000000;
|
|
s->psaconfig = 1;
|
|
|
|
s->padconf[0x00] = 0x000f0f0f;
|
|
s->padconf[0x01] = 0x00000000;
|
|
s->padconf[0x02] = 0x00000000;
|
|
s->padconf[0x03] = 0x00000000;
|
|
s->padconf[0x04] = 0x00000000;
|
|
s->padconf[0x05] = 0x00000000;
|
|
s->padconf[0x06] = 0x00000000;
|
|
s->padconf[0x07] = 0x00000000;
|
|
s->padconf[0x08] = 0x08080800;
|
|
s->padconf[0x09] = 0x08080808;
|
|
s->padconf[0x0a] = 0x08080808;
|
|
s->padconf[0x0b] = 0x08080808;
|
|
s->padconf[0x0c] = 0x08080808;
|
|
s->padconf[0x0d] = 0x08080800;
|
|
s->padconf[0x0e] = 0x08080808;
|
|
s->padconf[0x0f] = 0x08080808;
|
|
s->padconf[0x10] = 0x18181808; /* | 0x07070700 if SBoot3 */
|
|
s->padconf[0x11] = 0x18181818; /* | 0x07070707 if SBoot3 */
|
|
s->padconf[0x12] = 0x18181818; /* | 0x07070707 if SBoot3 */
|
|
s->padconf[0x13] = 0x18181818; /* | 0x07070707 if SBoot3 */
|
|
s->padconf[0x14] = 0x18181818; /* | 0x00070707 if SBoot3 */
|
|
s->padconf[0x15] = 0x18181818;
|
|
s->padconf[0x16] = 0x18181818; /* | 0x07000000 if SBoot3 */
|
|
s->padconf[0x17] = 0x1f001f00;
|
|
s->padconf[0x18] = 0x1f1f1f1f;
|
|
s->padconf[0x19] = 0x00000000;
|
|
s->padconf[0x1a] = 0x1f180000;
|
|
s->padconf[0x1b] = 0x00001f1f;
|
|
s->padconf[0x1c] = 0x1f001f00;
|
|
s->padconf[0x1d] = 0x00000000;
|
|
s->padconf[0x1e] = 0x00000000;
|
|
s->padconf[0x1f] = 0x08000000;
|
|
s->padconf[0x20] = 0x08080808;
|
|
s->padconf[0x21] = 0x08080808;
|
|
s->padconf[0x22] = 0x0f080808;
|
|
s->padconf[0x23] = 0x0f0f0f0f;
|
|
s->padconf[0x24] = 0x000f0f0f;
|
|
s->padconf[0x25] = 0x1f1f1f0f;
|
|
s->padconf[0x26] = 0x080f0f1f;
|
|
s->padconf[0x27] = 0x070f1808;
|
|
s->padconf[0x28] = 0x0f070707;
|
|
s->padconf[0x29] = 0x000f0f1f;
|
|
s->padconf[0x2a] = 0x0f0f0f1f;
|
|
s->padconf[0x2b] = 0x08000000;
|
|
s->padconf[0x2c] = 0x0000001f;
|
|
s->padconf[0x2d] = 0x0f0f1f00;
|
|
s->padconf[0x2e] = 0x1f1f0f0f;
|
|
s->padconf[0x2f] = 0x0f1f1f1f;
|
|
s->padconf[0x30] = 0x0f0f0f0f;
|
|
s->padconf[0x31] = 0x0f1f0f1f;
|
|
s->padconf[0x32] = 0x0f0f0f0f;
|
|
s->padconf[0x33] = 0x0f1f0f1f;
|
|
s->padconf[0x34] = 0x1f1f0f0f;
|
|
s->padconf[0x35] = 0x0f0f1f1f;
|
|
s->padconf[0x36] = 0x0f0f1f0f;
|
|
s->padconf[0x37] = 0x0f0f0f0f;
|
|
s->padconf[0x38] = 0x1f18180f;
|
|
s->padconf[0x39] = 0x1f1f1f1f;
|
|
s->padconf[0x3a] = 0x00001f1f;
|
|
s->padconf[0x3b] = 0x00000000;
|
|
s->padconf[0x3c] = 0x00000000;
|
|
s->padconf[0x3d] = 0x0f0f0f0f;
|
|
s->padconf[0x3e] = 0x18000f0f;
|
|
s->padconf[0x3f] = 0x00070000;
|
|
s->padconf[0x40] = 0x00000707;
|
|
s->padconf[0x41] = 0x0f1f0700;
|
|
s->padconf[0x42] = 0x1f1f070f;
|
|
s->padconf[0x43] = 0x0008081f;
|
|
s->padconf[0x44] = 0x00000800;
|
|
}
|
|
|
|
struct omap_sysctl_s *omap_sysctl_init(struct omap_target_agent_s *ta,
|
|
omap_clk iclk, struct omap_mpu_state_s *mpu)
|
|
{
|
|
int iomemtype;
|
|
struct omap_sysctl_s *s = (struct omap_sysctl_s *)
|
|
qemu_mallocz(sizeof(struct omap_sysctl_s));
|
|
|
|
s->mpu = mpu;
|
|
omap_sysctl_reset(s);
|
|
|
|
iomemtype = l4_register_io_memory(0, omap_sysctl_readfn,
|
|
omap_sysctl_writefn, s);
|
|
s->base = omap_l4_attach(ta, 0, iomemtype);
|
|
omap_l4_attach(ta, 0, iomemtype);
|
|
|
|
return s;
|
|
}
|
|
|
|
/* SDRAM Controller Subsystem */
|
|
struct omap_sdrc_s {
|
|
target_phys_addr_t base;
|
|
|
|
uint8_t config;
|
|
};
|
|
|
|
static void omap_sdrc_reset(struct omap_sdrc_s *s)
|
|
{
|
|
s->config = 0x10;
|
|
}
|
|
|
|
static uint32_t omap_sdrc_read(void *opaque, target_phys_addr_t addr)
|
|
{
|
|
struct omap_sdrc_s *s = (struct omap_sdrc_s *) opaque;
|
|
int offset = addr - s->base;
|
|
|
|
switch (offset) {
|
|
case 0x00: /* SDRC_REVISION */
|
|
return 0x20;
|
|
|
|
case 0x10: /* SDRC_SYSCONFIG */
|
|
return s->config;
|
|
|
|
case 0x14: /* SDRC_SYSSTATUS */
|
|
return 1; /* RESETDONE */
|
|
|
|
case 0x40: /* SDRC_CS_CFG */
|
|
case 0x44: /* SDRC_SHARING */
|
|
case 0x48: /* SDRC_ERR_ADDR */
|
|
case 0x4c: /* SDRC_ERR_TYPE */
|
|
case 0x60: /* SDRC_DLLA_SCTRL */
|
|
case 0x64: /* SDRC_DLLA_STATUS */
|
|
case 0x68: /* SDRC_DLLB_CTRL */
|
|
case 0x6c: /* SDRC_DLLB_STATUS */
|
|
case 0x70: /* SDRC_POWER */
|
|
case 0x80: /* SDRC_MCFG_0 */
|
|
case 0x84: /* SDRC_MR_0 */
|
|
case 0x88: /* SDRC_EMR1_0 */
|
|
case 0x8c: /* SDRC_EMR2_0 */
|
|
case 0x90: /* SDRC_EMR3_0 */
|
|
case 0x94: /* SDRC_DCDL1_CTRL */
|
|
case 0x98: /* SDRC_DCDL2_CTRL */
|
|
case 0x9c: /* SDRC_ACTIM_CTRLA_0 */
|
|
case 0xa0: /* SDRC_ACTIM_CTRLB_0 */
|
|
case 0xa4: /* SDRC_RFR_CTRL_0 */
|
|
case 0xa8: /* SDRC_MANUAL_0 */
|
|
case 0xb0: /* SDRC_MCFG_1 */
|
|
case 0xb4: /* SDRC_MR_1 */
|
|
case 0xb8: /* SDRC_EMR1_1 */
|
|
case 0xbc: /* SDRC_EMR2_1 */
|
|
case 0xc0: /* SDRC_EMR3_1 */
|
|
case 0xc4: /* SDRC_ACTIM_CTRLA_1 */
|
|
case 0xc8: /* SDRC_ACTIM_CTRLB_1 */
|
|
case 0xd4: /* SDRC_RFR_CTRL_1 */
|
|
case 0xd8: /* SDRC_MANUAL_1 */
|
|
return 0x00;
|
|
}
|
|
|
|
OMAP_BAD_REG(addr);
|
|
return 0;
|
|
}
|
|
|
|
static void omap_sdrc_write(void *opaque, target_phys_addr_t addr,
|
|
uint32_t value)
|
|
{
|
|
struct omap_sdrc_s *s = (struct omap_sdrc_s *) opaque;
|
|
int offset = addr - s->base;
|
|
|
|
switch (offset) {
|
|
case 0x00: /* SDRC_REVISION */
|
|
case 0x14: /* SDRC_SYSSTATUS */
|
|
case 0x48: /* SDRC_ERR_ADDR */
|
|
case 0x64: /* SDRC_DLLA_STATUS */
|
|
case 0x6c: /* SDRC_DLLB_STATUS */
|
|
OMAP_RO_REG(addr);
|
|
return;
|
|
|
|
case 0x10: /* SDRC_SYSCONFIG */
|
|
if ((value >> 3) != 0x2)
|
|
fprintf(stderr, "%s: bad SDRAM idle mode %i\n",
|
|
__FUNCTION__, value >> 3);
|
|
if (value & 2)
|
|
omap_sdrc_reset(s);
|
|
s->config = value & 0x18;
|
|
break;
|
|
|
|
case 0x40: /* SDRC_CS_CFG */
|
|
case 0x44: /* SDRC_SHARING */
|
|
case 0x4c: /* SDRC_ERR_TYPE */
|
|
case 0x60: /* SDRC_DLLA_SCTRL */
|
|
case 0x68: /* SDRC_DLLB_CTRL */
|
|
case 0x70: /* SDRC_POWER */
|
|
case 0x80: /* SDRC_MCFG_0 */
|
|
case 0x84: /* SDRC_MR_0 */
|
|
case 0x88: /* SDRC_EMR1_0 */
|
|
case 0x8c: /* SDRC_EMR2_0 */
|
|
case 0x90: /* SDRC_EMR3_0 */
|
|
case 0x94: /* SDRC_DCDL1_CTRL */
|
|
case 0x98: /* SDRC_DCDL2_CTRL */
|
|
case 0x9c: /* SDRC_ACTIM_CTRLA_0 */
|
|
case 0xa0: /* SDRC_ACTIM_CTRLB_0 */
|
|
case 0xa4: /* SDRC_RFR_CTRL_0 */
|
|
case 0xa8: /* SDRC_MANUAL_0 */
|
|
case 0xb0: /* SDRC_MCFG_1 */
|
|
case 0xb4: /* SDRC_MR_1 */
|
|
case 0xb8: /* SDRC_EMR1_1 */
|
|
case 0xbc: /* SDRC_EMR2_1 */
|
|
case 0xc0: /* SDRC_EMR3_1 */
|
|
case 0xc4: /* SDRC_ACTIM_CTRLA_1 */
|
|
case 0xc8: /* SDRC_ACTIM_CTRLB_1 */
|
|
case 0xd4: /* SDRC_RFR_CTRL_1 */
|
|
case 0xd8: /* SDRC_MANUAL_1 */
|
|
break;
|
|
|
|
default:
|
|
OMAP_BAD_REG(addr);
|
|
return;
|
|
}
|
|
}
|
|
|
|
static CPUReadMemoryFunc *omap_sdrc_readfn[] = {
|
|
omap_badwidth_read32,
|
|
omap_badwidth_read32,
|
|
omap_sdrc_read,
|
|
};
|
|
|
|
static CPUWriteMemoryFunc *omap_sdrc_writefn[] = {
|
|
omap_badwidth_write32,
|
|
omap_badwidth_write32,
|
|
omap_sdrc_write,
|
|
};
|
|
|
|
struct omap_sdrc_s *omap_sdrc_init(target_phys_addr_t base)
|
|
{
|
|
int iomemtype;
|
|
struct omap_sdrc_s *s = (struct omap_sdrc_s *)
|
|
qemu_mallocz(sizeof(struct omap_sdrc_s));
|
|
|
|
s->base = base;
|
|
omap_sdrc_reset(s);
|
|
|
|
iomemtype = cpu_register_io_memory(0, omap_sdrc_readfn,
|
|
omap_sdrc_writefn, s);
|
|
cpu_register_physical_memory(s->base, 0x1000, iomemtype);
|
|
|
|
return s;
|
|
}
|
|
|
|
/* General-Purpose Memory Controller */
|
|
struct omap_gpmc_s {
|
|
target_phys_addr_t base;
|
|
qemu_irq irq;
|
|
|
|
uint8_t sysconfig;
|
|
uint16_t irqst;
|
|
uint16_t irqen;
|
|
uint16_t timeout;
|
|
uint16_t config;
|
|
uint32_t prefconfig[2];
|
|
int prefcontrol;
|
|
int preffifo;
|
|
int prefcount;
|
|
struct omap_gpmc_cs_file_s {
|
|
uint32_t config[7];
|
|
target_phys_addr_t base;
|
|
size_t size;
|
|
int iomemtype;
|
|
void (*base_update)(void *opaque, target_phys_addr_t new);
|
|
void (*unmap)(void *opaque);
|
|
void *opaque;
|
|
} cs_file[8];
|
|
int ecc_cs;
|
|
int ecc_ptr;
|
|
uint32_t ecc_cfg;
|
|
struct ecc_state_s ecc[9];
|
|
};
|
|
|
|
static void omap_gpmc_int_update(struct omap_gpmc_s *s)
|
|
{
|
|
qemu_set_irq(s->irq, s->irqen & s->irqst);
|
|
}
|
|
|
|
static void omap_gpmc_cs_map(struct omap_gpmc_cs_file_s *f, int base, int mask)
|
|
{
|
|
/* TODO: check for overlapping regions and report access errors */
|
|
if ((mask != 0x8 && mask != 0xc && mask != 0xe && mask != 0xf) ||
|
|
(base < 0 || base >= 0x40) ||
|
|
(base & 0x0f & ~mask)) {
|
|
fprintf(stderr, "%s: wrong cs address mapping/decoding!\n",
|
|
__FUNCTION__);
|
|
return;
|
|
}
|
|
|
|
if (!f->opaque)
|
|
return;
|
|
|
|
f->base = base << 24;
|
|
f->size = (0x0fffffff & ~(mask << 24)) + 1;
|
|
/* TODO: rather than setting the size of the mapping (which should be
|
|
* constant), the mask should cause wrapping of the address space, so
|
|
* that the same memory becomes accessible at every <i>size</i> bytes
|
|
* starting from <i>base</i>. */
|
|
if (f->iomemtype)
|
|
cpu_register_physical_memory(f->base, f->size, f->iomemtype);
|
|
|
|
if (f->base_update)
|
|
f->base_update(f->opaque, f->base);
|
|
}
|
|
|
|
static void omap_gpmc_cs_unmap(struct omap_gpmc_cs_file_s *f)
|
|
{
|
|
if (f->size) {
|
|
if (f->unmap)
|
|
f->unmap(f->opaque);
|
|
if (f->iomemtype)
|
|
cpu_register_physical_memory(f->base, f->size, IO_MEM_UNASSIGNED);
|
|
f->base = 0;
|
|
f->size = 0;
|
|
}
|
|
}
|
|
|
|
static void omap_gpmc_reset(struct omap_gpmc_s *s)
|
|
{
|
|
int i;
|
|
|
|
s->sysconfig = 0;
|
|
s->irqst = 0;
|
|
s->irqen = 0;
|
|
omap_gpmc_int_update(s);
|
|
s->timeout = 0;
|
|
s->config = 0xa00;
|
|
s->prefconfig[0] = 0x00004000;
|
|
s->prefconfig[1] = 0x00000000;
|
|
s->prefcontrol = 0;
|
|
s->preffifo = 0;
|
|
s->prefcount = 0;
|
|
for (i = 0; i < 8; i ++) {
|
|
if (s->cs_file[i].config[6] & (1 << 6)) /* CSVALID */
|
|
omap_gpmc_cs_unmap(s->cs_file + i);
|
|
s->cs_file[i].config[0] = i ? 1 << 12 : 0;
|
|
s->cs_file[i].config[1] = 0x101001;
|
|
s->cs_file[i].config[2] = 0x020201;
|
|
s->cs_file[i].config[3] = 0x10031003;
|
|
s->cs_file[i].config[4] = 0x10f1111;
|
|
s->cs_file[i].config[5] = 0;
|
|
s->cs_file[i].config[6] = 0xf00 | (i ? 0 : 1 << 6);
|
|
if (s->cs_file[i].config[6] & (1 << 6)) /* CSVALID */
|
|
omap_gpmc_cs_map(&s->cs_file[i],
|
|
s->cs_file[i].config[6] & 0x1f, /* MASKADDR */
|
|
(s->cs_file[i].config[6] >> 8 & 0xf)); /* BASEADDR */
|
|
}
|
|
omap_gpmc_cs_map(s->cs_file, 0, 0xf);
|
|
s->ecc_cs = 0;
|
|
s->ecc_ptr = 0;
|
|
s->ecc_cfg = 0x3fcff000;
|
|
for (i = 0; i < 9; i ++)
|
|
ecc_reset(&s->ecc[i]);
|
|
}
|
|
|
|
static uint32_t omap_gpmc_read(void *opaque, target_phys_addr_t addr)
|
|
{
|
|
struct omap_gpmc_s *s = (struct omap_gpmc_s *) opaque;
|
|
int offset = addr - s->base;
|
|
int cs;
|
|
struct omap_gpmc_cs_file_s *f;
|
|
|
|
switch (offset) {
|
|
case 0x000: /* GPMC_REVISION */
|
|
return 0x20;
|
|
|
|
case 0x010: /* GPMC_SYSCONFIG */
|
|
return s->sysconfig;
|
|
|
|
case 0x014: /* GPMC_SYSSTATUS */
|
|
return 1; /* RESETDONE */
|
|
|
|
case 0x018: /* GPMC_IRQSTATUS */
|
|
return s->irqst;
|
|
|
|
case 0x01c: /* GPMC_IRQENABLE */
|
|
return s->irqen;
|
|
|
|
case 0x040: /* GPMC_TIMEOUT_CONTROL */
|
|
return s->timeout;
|
|
|
|
case 0x044: /* GPMC_ERR_ADDRESS */
|
|
case 0x048: /* GPMC_ERR_TYPE */
|
|
return 0;
|
|
|
|
case 0x050: /* GPMC_CONFIG */
|
|
return s->config;
|
|
|
|
case 0x054: /* GPMC_STATUS */
|
|
return 0x001;
|
|
|
|
case 0x060 ... 0x1d4:
|
|
cs = (offset - 0x060) / 0x30;
|
|
offset -= cs * 0x30;
|
|
f = s->cs_file + cs;
|
|
switch (offset - cs * 0x30) {
|
|
case 0x60: /* GPMC_CONFIG1 */
|
|
return f->config[0];
|
|
case 0x64: /* GPMC_CONFIG2 */
|
|
return f->config[1];
|
|
case 0x68: /* GPMC_CONFIG3 */
|
|
return f->config[2];
|
|
case 0x6c: /* GPMC_CONFIG4 */
|
|
return f->config[3];
|
|
case 0x70: /* GPMC_CONFIG5 */
|
|
return f->config[4];
|
|
case 0x74: /* GPMC_CONFIG6 */
|
|
return f->config[5];
|
|
case 0x78: /* GPMC_CONFIG7 */
|
|
return f->config[6];
|
|
case 0x84: /* GPMC_NAND_DATA */
|
|
return 0;
|
|
}
|
|
break;
|
|
|
|
case 0x1e0: /* GPMC_PREFETCH_CONFIG1 */
|
|
return s->prefconfig[0];
|
|
case 0x1e4: /* GPMC_PREFETCH_CONFIG2 */
|
|
return s->prefconfig[1];
|
|
case 0x1ec: /* GPMC_PREFETCH_CONTROL */
|
|
return s->prefcontrol;
|
|
case 0x1f0: /* GPMC_PREFETCH_STATUS */
|
|
return (s->preffifo << 24) |
|
|
((s->preffifo >
|
|
((s->prefconfig[0] >> 8) & 0x7f) ? 1 : 0) << 16) |
|
|
s->prefcount;
|
|
|
|
case 0x1f4: /* GPMC_ECC_CONFIG */
|
|
return s->ecc_cs;
|
|
case 0x1f8: /* GPMC_ECC_CONTROL */
|
|
return s->ecc_ptr;
|
|
case 0x1fc: /* GPMC_ECC_SIZE_CONFIG */
|
|
return s->ecc_cfg;
|
|
case 0x200 ... 0x220: /* GPMC_ECC_RESULT */
|
|
cs = (offset & 0x1f) >> 2;
|
|
/* TODO: check correctness */
|
|
return
|
|
((s->ecc[cs].cp & 0x07) << 0) |
|
|
((s->ecc[cs].cp & 0x38) << 13) |
|
|
((s->ecc[cs].lp[0] & 0x1ff) << 3) |
|
|
((s->ecc[cs].lp[1] & 0x1ff) << 19);
|
|
|
|
case 0x230: /* GPMC_TESTMODE_CTRL */
|
|
return 0;
|
|
case 0x234: /* GPMC_PSA_LSB */
|
|
case 0x238: /* GPMC_PSA_MSB */
|
|
return 0x00000000;
|
|
}
|
|
|
|
OMAP_BAD_REG(addr);
|
|
return 0;
|
|
}
|
|
|
|
static void omap_gpmc_write(void *opaque, target_phys_addr_t addr,
|
|
uint32_t value)
|
|
{
|
|
struct omap_gpmc_s *s = (struct omap_gpmc_s *) opaque;
|
|
int offset = addr - s->base;
|
|
int cs;
|
|
struct omap_gpmc_cs_file_s *f;
|
|
|
|
switch (offset) {
|
|
case 0x000: /* GPMC_REVISION */
|
|
case 0x014: /* GPMC_SYSSTATUS */
|
|
case 0x054: /* GPMC_STATUS */
|
|
case 0x1f0: /* GPMC_PREFETCH_STATUS */
|
|
case 0x200 ... 0x220: /* GPMC_ECC_RESULT */
|
|
case 0x234: /* GPMC_PSA_LSB */
|
|
case 0x238: /* GPMC_PSA_MSB */
|
|
OMAP_RO_REG(addr);
|
|
break;
|
|
|
|
case 0x010: /* GPMC_SYSCONFIG */
|
|
if ((value >> 3) == 0x3)
|
|
fprintf(stderr, "%s: bad SDRAM idle mode %i\n",
|
|
__FUNCTION__, value >> 3);
|
|
if (value & 2)
|
|
omap_gpmc_reset(s);
|
|
s->sysconfig = value & 0x19;
|
|
break;
|
|
|
|
case 0x018: /* GPMC_IRQSTATUS */
|
|
s->irqen = ~value;
|
|
omap_gpmc_int_update(s);
|
|
break;
|
|
|
|
case 0x01c: /* GPMC_IRQENABLE */
|
|
s->irqen = value & 0xf03;
|
|
omap_gpmc_int_update(s);
|
|
break;
|
|
|
|
case 0x040: /* GPMC_TIMEOUT_CONTROL */
|
|
s->timeout = value & 0x1ff1;
|
|
break;
|
|
|
|
case 0x044: /* GPMC_ERR_ADDRESS */
|
|
case 0x048: /* GPMC_ERR_TYPE */
|
|
break;
|
|
|
|
case 0x050: /* GPMC_CONFIG */
|
|
s->config = value & 0xf13;
|
|
break;
|
|
|
|
case 0x060 ... 0x1d4:
|
|
cs = (offset - 0x060) / 0x30;
|
|
offset -= cs * 0x30;
|
|
f = s->cs_file + cs;
|
|
switch (offset) {
|
|
case 0x60: /* GPMC_CONFIG1 */
|
|
f->config[0] = value & 0xffef3e13;
|
|
break;
|
|
case 0x64: /* GPMC_CONFIG2 */
|
|
f->config[1] = value & 0x001f1f8f;
|
|
break;
|
|
case 0x68: /* GPMC_CONFIG3 */
|
|
f->config[2] = value & 0x001f1f8f;
|
|
break;
|
|
case 0x6c: /* GPMC_CONFIG4 */
|
|
f->config[3] = value & 0x1f8f1f8f;
|
|
break;
|
|
case 0x70: /* GPMC_CONFIG5 */
|
|
f->config[4] = value & 0x0f1f1f1f;
|
|
break;
|
|
case 0x74: /* GPMC_CONFIG6 */
|
|
f->config[5] = value & 0x00000fcf;
|
|
break;
|
|
case 0x78: /* GPMC_CONFIG7 */
|
|
if ((f->config[6] ^ value) & 0xf7f) {
|
|
if (f->config[6] & (1 << 6)) /* CSVALID */
|
|
omap_gpmc_cs_unmap(f);
|
|
if (value & (1 << 6)) /* CSVALID */
|
|
omap_gpmc_cs_map(f, value & 0x1f, /* MASKADDR */
|
|
(value >> 8 & 0xf)); /* BASEADDR */
|
|
}
|
|
f->config[6] = value & 0x00000f7f;
|
|
break;
|
|
case 0x7c: /* GPMC_NAND_COMMAND */
|
|
case 0x80: /* GPMC_NAND_ADDRESS */
|
|
case 0x84: /* GPMC_NAND_DATA */
|
|
break;
|
|
|
|
default:
|
|
goto bad_reg;
|
|
}
|
|
break;
|
|
|
|
case 0x1e0: /* GPMC_PREFETCH_CONFIG1 */
|
|
s->prefconfig[0] = value & 0x7f8f7fbf;
|
|
/* TODO: update interrupts, fifos, dmas */
|
|
break;
|
|
|
|
case 0x1e4: /* GPMC_PREFETCH_CONFIG2 */
|
|
s->prefconfig[1] = value & 0x3fff;
|
|
break;
|
|
|
|
case 0x1ec: /* GPMC_PREFETCH_CONTROL */
|
|
s->prefcontrol = value & 1;
|
|
if (s->prefcontrol) {
|
|
if (s->prefconfig[0] & 1)
|
|
s->preffifo = 0x40;
|
|
else
|
|
s->preffifo = 0x00;
|
|
}
|
|
/* TODO: start */
|
|
break;
|
|
|
|
case 0x1f4: /* GPMC_ECC_CONFIG */
|
|
s->ecc_cs = 0x8f;
|
|
break;
|
|
case 0x1f8: /* GPMC_ECC_CONTROL */
|
|
if (value & (1 << 8))
|
|
for (cs = 0; cs < 9; cs ++)
|
|
ecc_reset(&s->ecc[cs]);
|
|
s->ecc_ptr = value & 0xf;
|
|
if (s->ecc_ptr == 0 || s->ecc_ptr > 9) {
|
|
s->ecc_ptr = 0;
|
|
s->ecc_cs &= ~1;
|
|
}
|
|
break;
|
|
case 0x1fc: /* GPMC_ECC_SIZE_CONFIG */
|
|
s->ecc_cfg = value & 0x3fcff1ff;
|
|
break;
|
|
case 0x230: /* GPMC_TESTMODE_CTRL */
|
|
if (value & 7)
|
|
fprintf(stderr, "%s: test mode enable attempt\n", __FUNCTION__);
|
|
break;
|
|
|
|
default:
|
|
bad_reg:
|
|
OMAP_BAD_REG(addr);
|
|
return;
|
|
}
|
|
}
|
|
|
|
static CPUReadMemoryFunc *omap_gpmc_readfn[] = {
|
|
omap_badwidth_read32, /* TODO */
|
|
omap_badwidth_read32, /* TODO */
|
|
omap_gpmc_read,
|
|
};
|
|
|
|
static CPUWriteMemoryFunc *omap_gpmc_writefn[] = {
|
|
omap_badwidth_write32, /* TODO */
|
|
omap_badwidth_write32, /* TODO */
|
|
omap_gpmc_write,
|
|
};
|
|
|
|
struct omap_gpmc_s *omap_gpmc_init(target_phys_addr_t base, qemu_irq irq)
|
|
{
|
|
int iomemtype;
|
|
struct omap_gpmc_s *s = (struct omap_gpmc_s *)
|
|
qemu_mallocz(sizeof(struct omap_gpmc_s));
|
|
|
|
s->base = base;
|
|
omap_gpmc_reset(s);
|
|
|
|
iomemtype = cpu_register_io_memory(0, omap_gpmc_readfn,
|
|
omap_gpmc_writefn, s);
|
|
cpu_register_physical_memory(s->base, 0x1000, iomemtype);
|
|
|
|
return s;
|
|
}
|
|
|
|
void omap_gpmc_attach(struct omap_gpmc_s *s, int cs, int iomemtype,
|
|
void (*base_upd)(void *opaque, target_phys_addr_t new),
|
|
void (*unmap)(void *opaque), void *opaque)
|
|
{
|
|
struct omap_gpmc_cs_file_s *f;
|
|
|
|
if (cs < 0 || cs >= 8) {
|
|
fprintf(stderr, "%s: bad chip-select %i\n", __FUNCTION__, cs);
|
|
exit(-1);
|
|
}
|
|
f = &s->cs_file[cs];
|
|
|
|
f->iomemtype = iomemtype;
|
|
f->base_update = base_upd;
|
|
f->unmap = unmap;
|
|
f->opaque = opaque;
|
|
|
|
if (f->config[6] & (1 << 6)) /* CSVALID */
|
|
omap_gpmc_cs_map(f, f->config[6] & 0x1f, /* MASKADDR */
|
|
(f->config[6] >> 8 & 0xf)); /* BASEADDR */
|
|
}
|
|
|
|
/* General chip reset */
|
|
static void omap2_mpu_reset(void *opaque)
|
|
{
|
|
struct omap_mpu_state_s *mpu = (struct omap_mpu_state_s *) opaque;
|
|
|
|
omap_inth_reset(mpu->ih[0]);
|
|
omap_dma_reset(mpu->dma);
|
|
omap_prcm_reset(mpu->prcm);
|
|
omap_sysctl_reset(mpu->sysc);
|
|
omap_gp_timer_reset(mpu->gptimer[0]);
|
|
omap_gp_timer_reset(mpu->gptimer[1]);
|
|
omap_gp_timer_reset(mpu->gptimer[2]);
|
|
omap_gp_timer_reset(mpu->gptimer[3]);
|
|
omap_gp_timer_reset(mpu->gptimer[4]);
|
|
omap_gp_timer_reset(mpu->gptimer[5]);
|
|
omap_gp_timer_reset(mpu->gptimer[6]);
|
|
omap_gp_timer_reset(mpu->gptimer[7]);
|
|
omap_gp_timer_reset(mpu->gptimer[8]);
|
|
omap_gp_timer_reset(mpu->gptimer[9]);
|
|
omap_gp_timer_reset(mpu->gptimer[10]);
|
|
omap_gp_timer_reset(mpu->gptimer[11]);
|
|
omap_synctimer_reset(&mpu->synctimer);
|
|
omap_sdrc_reset(mpu->sdrc);
|
|
omap_gpmc_reset(mpu->gpmc);
|
|
omap_dss_reset(mpu->dss);
|
|
omap_uart_reset(mpu->uart[0]);
|
|
omap_uart_reset(mpu->uart[1]);
|
|
omap_uart_reset(mpu->uart[2]);
|
|
omap_mmc_reset(mpu->mmc);
|
|
omap_gpif_reset(mpu->gpif);
|
|
omap_mcspi_reset(mpu->mcspi[0]);
|
|
omap_mcspi_reset(mpu->mcspi[1]);
|
|
omap_i2c_reset(mpu->i2c[0]);
|
|
omap_i2c_reset(mpu->i2c[1]);
|
|
cpu_reset(mpu->env);
|
|
}
|
|
|
|
static int omap2_validate_addr(struct omap_mpu_state_s *s,
|
|
target_phys_addr_t addr)
|
|
{
|
|
return 1;
|
|
}
|
|
|
|
static const struct dma_irq_map omap2_dma_irq_map[] = {
|
|
{ 0, OMAP_INT_24XX_SDMA_IRQ0 },
|
|
{ 0, OMAP_INT_24XX_SDMA_IRQ1 },
|
|
{ 0, OMAP_INT_24XX_SDMA_IRQ2 },
|
|
{ 0, OMAP_INT_24XX_SDMA_IRQ3 },
|
|
};
|
|
|
|
struct omap_mpu_state_s *omap2420_mpu_init(unsigned long sdram_size,
|
|
DisplayState *ds, const char *core)
|
|
{
|
|
struct omap_mpu_state_s *s = (struct omap_mpu_state_s *)
|
|
qemu_mallocz(sizeof(struct omap_mpu_state_s));
|
|
ram_addr_t sram_base, q2_base;
|
|
qemu_irq *cpu_irq;
|
|
qemu_irq dma_irqs[4];
|
|
omap_clk gpio_clks[4];
|
|
int sdindex;
|
|
int i;
|
|
|
|
/* Core */
|
|
s->mpu_model = omap2420;
|
|
s->env = cpu_init(core ?: "arm1136-r2");
|
|
if (!s->env) {
|
|
fprintf(stderr, "Unable to find CPU definition\n");
|
|
exit(1);
|
|
}
|
|
s->sdram_size = sdram_size;
|
|
s->sram_size = OMAP242X_SRAM_SIZE;
|
|
|
|
s->wakeup = qemu_allocate_irqs(omap_mpu_wakeup, s, 1)[0];
|
|
|
|
/* Clocks */
|
|
omap_clk_init(s);
|
|
|
|
/* Memory-mapped stuff */
|
|
cpu_register_physical_memory(OMAP2_Q2_BASE, s->sdram_size,
|
|
(q2_base = qemu_ram_alloc(s->sdram_size)) | IO_MEM_RAM);
|
|
cpu_register_physical_memory(OMAP2_SRAM_BASE, s->sram_size,
|
|
(sram_base = qemu_ram_alloc(s->sram_size)) | IO_MEM_RAM);
|
|
|
|
s->l4 = omap_l4_init(OMAP2_L4_BASE, 54);
|
|
|
|
/* Actually mapped at any 2K boundary in the ARM11 private-peripheral if */
|
|
cpu_irq = arm_pic_init_cpu(s->env);
|
|
s->ih[0] = omap2_inth_init(0x480fe000, 0x1000, 3, &s->irq[0],
|
|
cpu_irq[ARM_PIC_CPU_IRQ], cpu_irq[ARM_PIC_CPU_FIQ],
|
|
omap_findclk(s, "mpu_intc_fclk"),
|
|
omap_findclk(s, "mpu_intc_iclk"));
|
|
|
|
s->prcm = omap_prcm_init(omap_l4tao(s->l4, 3),
|
|
s->irq[0][OMAP_INT_24XX_PRCM_MPU_IRQ], NULL, NULL, s);
|
|
|
|
s->sysc = omap_sysctl_init(omap_l4tao(s->l4, 1),
|
|
omap_findclk(s, "omapctrl_iclk"), s);
|
|
|
|
for (i = 0; i < 4; i ++)
|
|
dma_irqs[i] =
|
|
s->irq[omap2_dma_irq_map[i].ih][omap2_dma_irq_map[i].intr];
|
|
s->dma = omap_dma4_init(0x48056000, dma_irqs, s, 256, 32,
|
|
omap_findclk(s, "sdma_iclk"),
|
|
omap_findclk(s, "sdma_fclk"));
|
|
s->port->addr_valid = omap2_validate_addr;
|
|
|
|
s->uart[0] = omap2_uart_init(omap_l4ta(s->l4, 19),
|
|
s->irq[0][OMAP_INT_24XX_UART1_IRQ],
|
|
omap_findclk(s, "uart1_fclk"),
|
|
omap_findclk(s, "uart1_iclk"),
|
|
s->drq[OMAP24XX_DMA_UART1_TX],
|
|
s->drq[OMAP24XX_DMA_UART1_RX], serial_hds[0]);
|
|
s->uart[1] = omap2_uart_init(omap_l4ta(s->l4, 20),
|
|
s->irq[0][OMAP_INT_24XX_UART2_IRQ],
|
|
omap_findclk(s, "uart2_fclk"),
|
|
omap_findclk(s, "uart2_iclk"),
|
|
s->drq[OMAP24XX_DMA_UART2_TX],
|
|
s->drq[OMAP24XX_DMA_UART2_RX],
|
|
serial_hds[0] ? serial_hds[1] : 0);
|
|
s->uart[2] = omap2_uart_init(omap_l4ta(s->l4, 21),
|
|
s->irq[0][OMAP_INT_24XX_UART3_IRQ],
|
|
omap_findclk(s, "uart3_fclk"),
|
|
omap_findclk(s, "uart3_iclk"),
|
|
s->drq[OMAP24XX_DMA_UART3_TX],
|
|
s->drq[OMAP24XX_DMA_UART3_RX],
|
|
serial_hds[0] && serial_hds[1] ? serial_hds[2] : 0);
|
|
|
|
s->gptimer[0] = omap_gp_timer_init(omap_l4ta(s->l4, 7),
|
|
s->irq[0][OMAP_INT_24XX_GPTIMER1],
|
|
omap_findclk(s, "wu_gpt1_clk"),
|
|
omap_findclk(s, "wu_l4_iclk"));
|
|
s->gptimer[1] = omap_gp_timer_init(omap_l4ta(s->l4, 8),
|
|
s->irq[0][OMAP_INT_24XX_GPTIMER2],
|
|
omap_findclk(s, "core_gpt2_clk"),
|
|
omap_findclk(s, "core_l4_iclk"));
|
|
s->gptimer[2] = omap_gp_timer_init(omap_l4ta(s->l4, 22),
|
|
s->irq[0][OMAP_INT_24XX_GPTIMER3],
|
|
omap_findclk(s, "core_gpt3_clk"),
|
|
omap_findclk(s, "core_l4_iclk"));
|
|
s->gptimer[3] = omap_gp_timer_init(omap_l4ta(s->l4, 23),
|
|
s->irq[0][OMAP_INT_24XX_GPTIMER4],
|
|
omap_findclk(s, "core_gpt4_clk"),
|
|
omap_findclk(s, "core_l4_iclk"));
|
|
s->gptimer[4] = omap_gp_timer_init(omap_l4ta(s->l4, 24),
|
|
s->irq[0][OMAP_INT_24XX_GPTIMER5],
|
|
omap_findclk(s, "core_gpt5_clk"),
|
|
omap_findclk(s, "core_l4_iclk"));
|
|
s->gptimer[5] = omap_gp_timer_init(omap_l4ta(s->l4, 25),
|
|
s->irq[0][OMAP_INT_24XX_GPTIMER6],
|
|
omap_findclk(s, "core_gpt6_clk"),
|
|
omap_findclk(s, "core_l4_iclk"));
|
|
s->gptimer[6] = omap_gp_timer_init(omap_l4ta(s->l4, 26),
|
|
s->irq[0][OMAP_INT_24XX_GPTIMER7],
|
|
omap_findclk(s, "core_gpt7_clk"),
|
|
omap_findclk(s, "core_l4_iclk"));
|
|
s->gptimer[7] = omap_gp_timer_init(omap_l4ta(s->l4, 27),
|
|
s->irq[0][OMAP_INT_24XX_GPTIMER8],
|
|
omap_findclk(s, "core_gpt8_clk"),
|
|
omap_findclk(s, "core_l4_iclk"));
|
|
s->gptimer[8] = omap_gp_timer_init(omap_l4ta(s->l4, 28),
|
|
s->irq[0][OMAP_INT_24XX_GPTIMER9],
|
|
omap_findclk(s, "core_gpt9_clk"),
|
|
omap_findclk(s, "core_l4_iclk"));
|
|
s->gptimer[9] = omap_gp_timer_init(omap_l4ta(s->l4, 29),
|
|
s->irq[0][OMAP_INT_24XX_GPTIMER10],
|
|
omap_findclk(s, "core_gpt10_clk"),
|
|
omap_findclk(s, "core_l4_iclk"));
|
|
s->gptimer[10] = omap_gp_timer_init(omap_l4ta(s->l4, 30),
|
|
s->irq[0][OMAP_INT_24XX_GPTIMER11],
|
|
omap_findclk(s, "core_gpt11_clk"),
|
|
omap_findclk(s, "core_l4_iclk"));
|
|
s->gptimer[11] = omap_gp_timer_init(omap_l4ta(s->l4, 31),
|
|
s->irq[0][OMAP_INT_24XX_GPTIMER12],
|
|
omap_findclk(s, "core_gpt12_clk"),
|
|
omap_findclk(s, "core_l4_iclk"));
|
|
|
|
omap_tap_init(omap_l4ta(s->l4, 2), s);
|
|
|
|
omap_synctimer_init(omap_l4tao(s->l4, 2), s,
|
|
omap_findclk(s, "clk32-kHz"),
|
|
omap_findclk(s, "core_l4_iclk"));
|
|
|
|
s->i2c[0] = omap2_i2c_init(omap_l4tao(s->l4, 5),
|
|
s->irq[0][OMAP_INT_24XX_I2C1_IRQ],
|
|
&s->drq[OMAP24XX_DMA_I2C1_TX],
|
|
omap_findclk(s, "i2c1.fclk"),
|
|
omap_findclk(s, "i2c1.iclk"));
|
|
s->i2c[1] = omap2_i2c_init(omap_l4tao(s->l4, 6),
|
|
s->irq[0][OMAP_INT_24XX_I2C2_IRQ],
|
|
&s->drq[OMAP24XX_DMA_I2C2_TX],
|
|
omap_findclk(s, "i2c2.fclk"),
|
|
omap_findclk(s, "i2c2.iclk"));
|
|
|
|
gpio_clks[0] = omap_findclk(s, "gpio1_dbclk");
|
|
gpio_clks[1] = omap_findclk(s, "gpio2_dbclk");
|
|
gpio_clks[2] = omap_findclk(s, "gpio3_dbclk");
|
|
gpio_clks[3] = omap_findclk(s, "gpio4_dbclk");
|
|
s->gpif = omap2_gpio_init(omap_l4ta(s->l4, 3),
|
|
&s->irq[0][OMAP_INT_24XX_GPIO_BANK1],
|
|
gpio_clks, omap_findclk(s, "gpio_iclk"), 4);
|
|
|
|
s->sdrc = omap_sdrc_init(0x68009000);
|
|
s->gpmc = omap_gpmc_init(0x6800a000, s->irq[0][OMAP_INT_24XX_GPMC_IRQ]);
|
|
|
|
sdindex = drive_get_index(IF_SD, 0, 0);
|
|
if (sdindex == -1) {
|
|
fprintf(stderr, "qemu: missing SecureDigital device\n");
|
|
exit(1);
|
|
}
|
|
s->mmc = omap2_mmc_init(omap_l4tao(s->l4, 9), drives_table[sdindex].bdrv,
|
|
s->irq[0][OMAP_INT_24XX_MMC_IRQ],
|
|
&s->drq[OMAP24XX_DMA_MMC1_TX],
|
|
omap_findclk(s, "mmc_fclk"), omap_findclk(s, "mmc_iclk"));
|
|
|
|
s->mcspi[0] = omap_mcspi_init(omap_l4ta(s->l4, 35), 4,
|
|
s->irq[0][OMAP_INT_24XX_MCSPI1_IRQ],
|
|
&s->drq[OMAP24XX_DMA_SPI1_TX0],
|
|
omap_findclk(s, "spi1_fclk"),
|
|
omap_findclk(s, "spi1_iclk"));
|
|
s->mcspi[1] = omap_mcspi_init(omap_l4ta(s->l4, 36), 2,
|
|
s->irq[0][OMAP_INT_24XX_MCSPI2_IRQ],
|
|
&s->drq[OMAP24XX_DMA_SPI2_TX0],
|
|
omap_findclk(s, "spi2_fclk"),
|
|
omap_findclk(s, "spi2_iclk"));
|
|
|
|
s->dss = omap_dss_init(omap_l4ta(s->l4, 10), 0x68000800, ds,
|
|
/* XXX wire M_IRQ_25, D_L2_IRQ_30 and I_IRQ_13 together */
|
|
s->irq[0][OMAP_INT_24XX_DSS_IRQ], s->drq[OMAP24XX_DMA_DSS],
|
|
omap_findclk(s, "dss_clk1"), omap_findclk(s, "dss_clk2"),
|
|
omap_findclk(s, "dss_54m_clk"),
|
|
omap_findclk(s, "dss_l3_iclk"),
|
|
omap_findclk(s, "dss_l4_iclk"));
|
|
|
|
omap_sti_init(omap_l4ta(s->l4, 18), 0x54000000,
|
|
s->irq[0][OMAP_INT_24XX_STI], omap_findclk(s, "emul_ck"),
|
|
serial_hds[0] && serial_hds[1] && serial_hds[2] ?
|
|
serial_hds[3] : 0);
|
|
|
|
/* All register mappings (includin those not currenlty implemented):
|
|
* SystemControlMod 48000000 - 48000fff
|
|
* SystemControlL4 48001000 - 48001fff
|
|
* 32kHz Timer Mod 48004000 - 48004fff
|
|
* 32kHz Timer L4 48005000 - 48005fff
|
|
* PRCM ModA 48008000 - 480087ff
|
|
* PRCM ModB 48008800 - 48008fff
|
|
* PRCM L4 48009000 - 48009fff
|
|
* TEST-BCM Mod 48012000 - 48012fff
|
|
* TEST-BCM L4 48013000 - 48013fff
|
|
* TEST-TAP Mod 48014000 - 48014fff
|
|
* TEST-TAP L4 48015000 - 48015fff
|
|
* GPIO1 Mod 48018000 - 48018fff
|
|
* GPIO Top 48019000 - 48019fff
|
|
* GPIO2 Mod 4801a000 - 4801afff
|
|
* GPIO L4 4801b000 - 4801bfff
|
|
* GPIO3 Mod 4801c000 - 4801cfff
|
|
* GPIO4 Mod 4801e000 - 4801efff
|
|
* WDTIMER1 Mod 48020000 - 48010fff
|
|
* WDTIMER Top 48021000 - 48011fff
|
|
* WDTIMER2 Mod 48022000 - 48012fff
|
|
* WDTIMER L4 48023000 - 48013fff
|
|
* WDTIMER3 Mod 48024000 - 48014fff
|
|
* WDTIMER3 L4 48025000 - 48015fff
|
|
* WDTIMER4 Mod 48026000 - 48016fff
|
|
* WDTIMER4 L4 48027000 - 48017fff
|
|
* GPTIMER1 Mod 48028000 - 48018fff
|
|
* GPTIMER1 L4 48029000 - 48019fff
|
|
* GPTIMER2 Mod 4802a000 - 4801afff
|
|
* GPTIMER2 L4 4802b000 - 4801bfff
|
|
* L4-Config AP 48040000 - 480407ff
|
|
* L4-Config IP 48040800 - 48040fff
|
|
* L4-Config LA 48041000 - 48041fff
|
|
* ARM11ETB Mod 48048000 - 48049fff
|
|
* ARM11ETB L4 4804a000 - 4804afff
|
|
* DISPLAY Top 48050000 - 480503ff
|
|
* DISPLAY DISPC 48050400 - 480507ff
|
|
* DISPLAY RFBI 48050800 - 48050bff
|
|
* DISPLAY VENC 48050c00 - 48050fff
|
|
* DISPLAY L4 48051000 - 48051fff
|
|
* CAMERA Top 48052000 - 480523ff
|
|
* CAMERA core 48052400 - 480527ff
|
|
* CAMERA DMA 48052800 - 48052bff
|
|
* CAMERA MMU 48052c00 - 48052fff
|
|
* CAMERA L4 48053000 - 48053fff
|
|
* SDMA Mod 48056000 - 48056fff
|
|
* SDMA L4 48057000 - 48057fff
|
|
* SSI Top 48058000 - 48058fff
|
|
* SSI GDD 48059000 - 48059fff
|
|
* SSI Port1 4805a000 - 4805afff
|
|
* SSI Port2 4805b000 - 4805bfff
|
|
* SSI L4 4805c000 - 4805cfff
|
|
* USB Mod 4805e000 - 480fefff
|
|
* USB L4 4805f000 - 480fffff
|
|
* WIN_TRACER1 Mod 48060000 - 48060fff
|
|
* WIN_TRACER1 L4 48061000 - 48061fff
|
|
* WIN_TRACER2 Mod 48062000 - 48062fff
|
|
* WIN_TRACER2 L4 48063000 - 48063fff
|
|
* WIN_TRACER3 Mod 48064000 - 48064fff
|
|
* WIN_TRACER3 L4 48065000 - 48065fff
|
|
* WIN_TRACER4 Top 48066000 - 480660ff
|
|
* WIN_TRACER4 ETT 48066100 - 480661ff
|
|
* WIN_TRACER4 WT 48066200 - 480662ff
|
|
* WIN_TRACER4 L4 48067000 - 48067fff
|
|
* XTI Mod 48068000 - 48068fff
|
|
* XTI L4 48069000 - 48069fff
|
|
* UART1 Mod 4806a000 - 4806afff
|
|
* UART1 L4 4806b000 - 4806bfff
|
|
* UART2 Mod 4806c000 - 4806cfff
|
|
* UART2 L4 4806d000 - 4806dfff
|
|
* UART3 Mod 4806e000 - 4806efff
|
|
* UART3 L4 4806f000 - 4806ffff
|
|
* I2C1 Mod 48070000 - 48070fff
|
|
* I2C1 L4 48071000 - 48071fff
|
|
* I2C2 Mod 48072000 - 48072fff
|
|
* I2C2 L4 48073000 - 48073fff
|
|
* McBSP1 Mod 48074000 - 48074fff
|
|
* McBSP1 L4 48075000 - 48075fff
|
|
* McBSP2 Mod 48076000 - 48076fff
|
|
* McBSP2 L4 48077000 - 48077fff
|
|
* GPTIMER3 Mod 48078000 - 48078fff
|
|
* GPTIMER3 L4 48079000 - 48079fff
|
|
* GPTIMER4 Mod 4807a000 - 4807afff
|
|
* GPTIMER4 L4 4807b000 - 4807bfff
|
|
* GPTIMER5 Mod 4807c000 - 4807cfff
|
|
* GPTIMER5 L4 4807d000 - 4807dfff
|
|
* GPTIMER6 Mod 4807e000 - 4807efff
|
|
* GPTIMER6 L4 4807f000 - 4807ffff
|
|
* GPTIMER7 Mod 48080000 - 48080fff
|
|
* GPTIMER7 L4 48081000 - 48081fff
|
|
* GPTIMER8 Mod 48082000 - 48082fff
|
|
* GPTIMER8 L4 48083000 - 48083fff
|
|
* GPTIMER9 Mod 48084000 - 48084fff
|
|
* GPTIMER9 L4 48085000 - 48085fff
|
|
* GPTIMER10 Mod 48086000 - 48086fff
|
|
* GPTIMER10 L4 48087000 - 48087fff
|
|
* GPTIMER11 Mod 48088000 - 48088fff
|
|
* GPTIMER11 L4 48089000 - 48089fff
|
|
* GPTIMER12 Mod 4808a000 - 4808afff
|
|
* GPTIMER12 L4 4808b000 - 4808bfff
|
|
* EAC Mod 48090000 - 48090fff
|
|
* EAC L4 48091000 - 48091fff
|
|
* FAC Mod 48092000 - 48092fff
|
|
* FAC L4 48093000 - 48093fff
|
|
* MAILBOX Mod 48094000 - 48094fff
|
|
* MAILBOX L4 48095000 - 48095fff
|
|
* SPI1 Mod 48098000 - 48098fff
|
|
* SPI1 L4 48099000 - 48099fff
|
|
* SPI2 Mod 4809a000 - 4809afff
|
|
* SPI2 L4 4809b000 - 4809bfff
|
|
* MMC/SDIO Mod 4809c000 - 4809cfff
|
|
* MMC/SDIO L4 4809d000 - 4809dfff
|
|
* MS_PRO Mod 4809e000 - 4809efff
|
|
* MS_PRO L4 4809f000 - 4809ffff
|
|
* RNG Mod 480a0000 - 480a0fff
|
|
* RNG L4 480a1000 - 480a1fff
|
|
* DES3DES Mod 480a2000 - 480a2fff
|
|
* DES3DES L4 480a3000 - 480a3fff
|
|
* SHA1MD5 Mod 480a4000 - 480a4fff
|
|
* SHA1MD5 L4 480a5000 - 480a5fff
|
|
* AES Mod 480a6000 - 480a6fff
|
|
* AES L4 480a7000 - 480a7fff
|
|
* PKA Mod 480a8000 - 480a9fff
|
|
* PKA L4 480aa000 - 480aafff
|
|
* MG Mod 480b0000 - 480b0fff
|
|
* MG L4 480b1000 - 480b1fff
|
|
* HDQ/1-wire Mod 480b2000 - 480b2fff
|
|
* HDQ/1-wire L4 480b3000 - 480b3fff
|
|
* MPU interrupt 480fe000 - 480fefff
|
|
* STI channel base 54000000 - 5400ffff
|
|
* IVA RAM 5c000000 - 5c01ffff
|
|
* IVA ROM 5c020000 - 5c027fff
|
|
* IMG_BUF_A 5c040000 - 5c040fff
|
|
* IMG_BUF_B 5c042000 - 5c042fff
|
|
* VLCDS 5c048000 - 5c0487ff
|
|
* IMX_COEF 5c049000 - 5c04afff
|
|
* IMX_CMD 5c051000 - 5c051fff
|
|
* VLCDQ 5c053000 - 5c0533ff
|
|
* VLCDH 5c054000 - 5c054fff
|
|
* SEQ_CMD 5c055000 - 5c055fff
|
|
* IMX_REG 5c056000 - 5c0560ff
|
|
* VLCD_REG 5c056100 - 5c0561ff
|
|
* SEQ_REG 5c056200 - 5c0562ff
|
|
* IMG_BUF_REG 5c056300 - 5c0563ff
|
|
* SEQIRQ_REG 5c056400 - 5c0564ff
|
|
* OCP_REG 5c060000 - 5c060fff
|
|
* SYSC_REG 5c070000 - 5c070fff
|
|
* MMU_REG 5d000000 - 5d000fff
|
|
* sDMA R 68000400 - 680005ff
|
|
* sDMA W 68000600 - 680007ff
|
|
* Display Control 68000800 - 680009ff
|
|
* DSP subsystem 68000a00 - 68000bff
|
|
* MPU subsystem 68000c00 - 68000dff
|
|
* IVA subsystem 68001000 - 680011ff
|
|
* USB 68001200 - 680013ff
|
|
* Camera 68001400 - 680015ff
|
|
* VLYNQ (firewall) 68001800 - 68001bff
|
|
* VLYNQ 68001e00 - 68001fff
|
|
* SSI 68002000 - 680021ff
|
|
* L4 68002400 - 680025ff
|
|
* DSP (firewall) 68002800 - 68002bff
|
|
* DSP subsystem 68002e00 - 68002fff
|
|
* IVA (firewall) 68003000 - 680033ff
|
|
* IVA 68003600 - 680037ff
|
|
* GFX 68003a00 - 68003bff
|
|
* CMDWR emulation 68003c00 - 68003dff
|
|
* SMS 68004000 - 680041ff
|
|
* OCM 68004200 - 680043ff
|
|
* GPMC 68004400 - 680045ff
|
|
* RAM (firewall) 68005000 - 680053ff
|
|
* RAM (err login) 68005400 - 680057ff
|
|
* ROM (firewall) 68005800 - 68005bff
|
|
* ROM (err login) 68005c00 - 68005fff
|
|
* GPMC (firewall) 68006000 - 680063ff
|
|
* GPMC (err login) 68006400 - 680067ff
|
|
* SMS (err login) 68006c00 - 68006fff
|
|
* SMS registers 68008000 - 68008fff
|
|
* SDRC registers 68009000 - 68009fff
|
|
* GPMC registers 6800a000 6800afff
|
|
*/
|
|
|
|
qemu_register_reset(omap2_mpu_reset, s);
|
|
|
|
return s;
|
|
}
|