Message ID | 4EF0DDAB.2030905@calxeda.com |
---|---|
State | New |
Headers | show |
On 20 December 2011 19:10, Mark Langsdorf <mark.langsdorf@calxeda.com> wrote: > From: Rob Herring <rob.herring@calxeda.com> > > Add power control and non-secure access ctrl registers > > Signed-off-by: Rob Herring <rob.herring@calxeda.com> > Signed-off-by: Mark Langsdorf <mark.langsdorf@calxeda.com> > --- > hw/a9mpcore.c | 26 ++++++++++++++++++++++++-- > 1 files changed, 24 insertions(+), 2 deletions(-) > > diff --git a/hw/a9mpcore.c b/hw/a9mpcore.c > index cd2985f..6e03fad 100644 > --- a/hw/a9mpcore.c > +++ b/hw/a9mpcore.c > @@ -29,6 +29,7 @@ gic_get_current_cpu(void) > typedef struct a9mp_priv_state { > gic_state gic; > uint32_t scu_control; > + uint32_t scu_status; > uint32_t old_timer_status[8]; > uint32_t num_cpu; > qemu_irq *timer_irq; New registers need to be added to the VMStateDescription too. > @@ -48,7 +49,13 @@ static uint64_t a9_scu_read(void *opaque, > target_phys_addr_t offset, > case 0x04: /* Configuration */ > return (((1 << s->num_cpu) - 1) << 4) | (s->num_cpu - 1); > case 0x08: /* CPU Power Status */ > - return 0; > + return s->scu_status; > + case 0x09: /* CPU status. */ > + return s->scu_status >> 8; > + case 0x0a: /* CPU status. */ > + return s->scu_status >> 16; > + case 0x0b: /* CPU status. */ > + return s->scu_status >> 24; > case 0x0c: /* Invalidate All Registers In Secure State */ > return 0; > case 0x40: /* Filtering Start Address Register */ > @@ -73,6 +80,22 @@ static void a9_scu_write(void *opaque, target_phys_addr_t > offset, > break; > case 0x4: /* Configuration: RO */ > break; > + case 0x08: /* Power Control */ > + s->scu_status &= ~0xff; > + s->scu_status |= value & 0xff; > + break; > + case 0x09: /* Power Control */ > + s->scu_status &= ~(0xff << 8); > + s->scu_status |= (value & 0xff) << 8; > + break; > + case 0x0A: /* Power Control */ > + s->scu_status &= ~(0xff << 16); > + s->scu_status |= (value & 0xff) << 16; > + break; > + case 0x0B: /* Power Control */ > + s->scu_status &= ~(0xff << 24); > + s->scu_status |= (value & 0xff) << 24; > + break; This works for byte writes but will do the wrong thing for halfword and word writes to the register. > case 0x0c: /* Invalidate All Registers In Secure State */ > /* no-op as we do not implement caches */ > break; > @@ -80,7 +103,6 @@ static void a9_scu_write(void *opaque, target_phys_addr_t > offset, > case 0x44: /* Filtering End Address Register */ > /* RAZ/WI, like an implementation with only one AXI master */ > break; > - case 0x8: /* CPU Power Status */ > case 0x50: /* SCU Access Control Register */ > case 0x54: /* SCU Non-secure Access Control Register */ > /* unimplemented, fall through */ > -- > 1.7.5.4 -- PMM
diff --git a/hw/a9mpcore.c b/hw/a9mpcore.c index cd2985f..6e03fad 100644 --- a/hw/a9mpcore.c +++ b/hw/a9mpcore.c @@ -29,6 +29,7 @@ gic_get_current_cpu(void) typedef struct a9mp_priv_state { gic_state gic; uint32_t scu_control; + uint32_t scu_status; uint32_t old_timer_status[8]; uint32_t num_cpu; qemu_irq *timer_irq; @@ -48,7 +49,13 @@ static uint64_t a9_scu_read(void *opaque, target_phys_addr_t offset, case 0x04: /* Configuration */ return (((1 << s->num_cpu) - 1) << 4) | (s->num_cpu - 1); case 0x08: /* CPU Power Status */ - return 0; + return s->scu_status; + case 0x09: /* CPU status. */ + return s->scu_status >> 8; + case 0x0a: /* CPU status. */ + return s->scu_status >> 16; + case 0x0b: /* CPU status. */ + return s->scu_status >> 24; case 0x0c: /* Invalidate All Registers In Secure State */ return 0;