Re: [Qemu-devel] [PATCH V2] SH7750/51: add register BCR3, BCR4, PCR, RTCOR, RTCNT, RTCSR, SDMR2, SDMR3 and fix BCR2 support

[Aurelien Jarno <aurelien@aurel32.net>]

On Wed, Dec 17, 2008 at 10:18:52AM +0100, Jean-Christophe PLAGNIOL-VILLARD wrote:
> Signed-off-by: Jean-Christophe PLAGNIOL-VILLARD <plagnioj@jcrosoft.com>
> ---
>  hw/sh7750.c            |   65 ++++++++++++++++++++++++++++++++++++++++-------
>  hw/sh7750_regnames.c   |    4 +-
>  hw/sh7750_regs.h       |   13 ++++++++-
>  target-sh4/cpu.h       |    1 +
>  target-sh4/translate.c |    2 +
>  5 files changed, 71 insertions(+), 14 deletions(-)
> 
> diff --git a/hw/sh7750.c b/hw/sh7750.c
> index 4d1a806..cee3a41 100644
> --- a/hw/sh7750.c
> +++ b/hw/sh7750.c
> @@ -42,8 +42,12 @@ typedef struct SH7750State {
>      uint32_t periph_freq;
>      /* SDRAM controller */
>      uint32_t bcr1;
> -    uint32_t bcr2;
> +    uint16_t bcr2;
> +    uint16_t bcr3;
> +    uint32_t bcr4;
>      uint16_t rfcr;
> +    /* PCMCIA controller */
> +    uint16_t pcr;
>      /* IO ports */
>      uint16_t gpioic;
>      uint32_t pctra;
> @@ -66,7 +70,10 @@ typedef struct SH7750State {
>      struct intc_desc intc;
>  } SH7750State;
>  
> -
> +static int inline has_bcr3_and_bcr4(SH7750State * s)
> +{
> +	return (s->cpu->features & SH_FEATURE_BCR3_AND_BCR4);
> +}
>  /**********************************************************************
>   I/O ports
>  **********************************************************************/
> @@ -211,8 +218,17 @@ static uint32_t sh7750_mem_readw(void *opaque, target_phys_addr_t addr)
>      switch (addr) {
>      case SH7750_BCR2_A7:
>  	return s->bcr2;
> +    case SH7750_BCR3_A7:
> +	if(has_bcr3_and_bcr4(s)) {
> +	    return s->bcr3;
> +	} else {
> +	    error_access("word read", addr);
> +	    assert(0);

Do we really want an assert() here? That means that the user from the
virtual machine can kill the machine.

What happens on a real CPU? I would guess an exception is triggered.

> +	}
>      case SH7750_FRQCR_A7:
>  	return 0;
> +    case SH7750_PCR_A7:
> +	return s->pcr;
>      case SH7750_RFCR_A7:
>  	fprintf(stderr,
>  		"Read access to refresh count register, incrementing\n");
> @@ -221,6 +237,11 @@ static uint32_t sh7750_mem_readw(void *opaque, target_phys_addr_t addr)
>  	return porta_lines(s);
>      case SH7750_PDTRB_A7:
>  	return portb_lines(s);
> +    case SH7750_RTCOR_A7:
> +    case SH7750_RTCNT_A7:
> +    case SH7750_RTCSR_A7:
> +	ignore_access("word read", addr);
> +	return 0;
>      default:
>  	error_access("word read", addr);
>  	assert(0);
> @@ -235,6 +256,12 @@ static uint32_t sh7750_mem_readl(void *opaque, target_phys_addr_t addr)
>      case SH7750_BCR1_A7:
>  	return s->bcr1;
>      case SH7750_BCR4_A7:
> +	if(has_bcr3_and_bcr4(s)) {
> +	    return s->bcr4;
> +	} else {
> +	    error_access("long read", addr);
> +	    assert(0);
> +	}
>      case SH7750_WCR1_A7:
>      case SH7750_WCR2_A7:
>      case SH7750_WCR3_A7:
> @@ -271,19 +298,19 @@ static uint32_t sh7750_mem_readl(void *opaque, target_phys_addr_t addr)
>      }
>  }
>  
> +#define is_in_sdrmx(a, x) (a >= SH7750_SDMR ## x ## _A7 \
> +			&& a <= (SH7750_SDMR ## x ## _A7 + SH7750_SDMR ## x ## _REGNB))
>  static void sh7750_mem_writeb(void *opaque, target_phys_addr_t addr,
>  			      uint32_t mem_value)
>  {
> -    switch (addr) {
> -	/* PRECHARGE ? XXXXX */
> -    case SH7750_PRECHARGE0_A7:
> -    case SH7750_PRECHARGE1_A7:
> +
> +    if (is_in_sdrmx(addr, 2) || is_in_sdrmx(addr, 3)) {
>  	ignore_access("byte write", addr);
>  	return;
> -    default:
> -	error_access("byte write", addr);
> -	assert(0);
>      }
> +
> +    error_access("byte write", addr);
> +    assert(0);
>  }
>  
>  static void sh7750_mem_writew(void *opaque, target_phys_addr_t addr,
> @@ -298,8 +325,18 @@ static void sh7750_mem_writew(void *opaque, target_phys_addr_t addr,
>          s->bcr2 = mem_value;
>          return;
>      case SH7750_BCR3_A7:
> -    case SH7750_RTCOR_A7:
> +	if(has_bcr3_and_bcr4(s)) {
> +	    s->bcr3 = mem_value;
> +	    return;
> +	} else {
> +	    error_access("word write", addr);
> +	    assert(0);
> +	}
> +    case SH7750_PCR_A7:
> +	s->pcr = mem_value;
> +	return;
>      case SH7750_RTCNT_A7:
> +    case SH7750_RTCOR_A7:
>      case SH7750_RTCSR_A7:
>  	ignore_access("word write", addr);
>  	return;
> @@ -343,6 +380,14 @@ static void sh7750_mem_writel(void *opaque, target_phys_addr_t addr,
>          s->bcr1 = mem_value;
>          return;
>      case SH7750_BCR4_A7:
> +	if(has_bcr3_and_bcr4(s)) {
> +	    s->bcr4 = mem_value;
> +	    return;
> +	} else {
> +	    error_access("long write", addr);
> +	    assert(0);
> +	}
> +        return;
>      case SH7750_WCR1_A7:
>      case SH7750_WCR2_A7:
>      case SH7750_WCR3_A7:
> diff --git a/hw/sh7750_regnames.c b/hw/sh7750_regnames.c
> index 51283c9..4928151 100644
> --- a/hw/sh7750_regnames.c
> +++ b/hw/sh7750_regnames.c
> @@ -79,8 +79,8 @@ static regname_t regnames[] = {
>  	REGNAME(SH7750_ICR_A7)
>  	REGNAME(SH7750_BCR3_A7)
>  	REGNAME(SH7750_BCR4_A7)
> -	REGNAME(SH7750_PRECHARGE0_A7)
> -    REGNAME(SH7750_PRECHARGE1_A7) {(uint32_t) - 1, 0}
> +	REGNAME(SH7750_SDMR2_A7)
> +	REGNAME(SH7750_SDMR3_A7) {(uint32_t) - 1, 0}
>  };
>  
>  const char *regname(uint32_t addr)
> diff --git a/hw/sh7750_regs.h b/hw/sh7750_regs.h
> index c8fb328..5a23a2c 100644
> --- a/hw/sh7750_regs.h
> +++ b/hw/sh7750_regs.h
> @@ -979,6 +979,17 @@
>  
>  #define SH7750_RFCR_KEY       0xA400	/* RFCR write key */
>  
> +/* Synchronous DRAM mode registers - SDMR */
> +#define SH7750_SDMR2_REGOFS   0x900000	/* base offset */
> +#define SH7750_SDMR2_REGNB    0x0FFC	/* nb of register */
> +#define SH7750_SDMR2          SH7750_P4_REG32(SH7750_SDMR2_REGOFS)
> +#define SH7750_SDMR2_A7       SH7750_A7_REG32(SH7750_SDMR2_REGOFS)
> +
> +#define SH7750_SDMR3_REGOFS   0x940000	/* offset */
> +#define SH7750_SDMR3_REGNB    0x0FFC	/* nb of register */
> +#define SH7750_SDMR3          SH7750_P4_REG32(SH7750_SDMR3_REGOFS)
> +#define SH7750_SDMR3_A7       SH7750_A7_REG32(SH7750_SDMR3_REGOFS)
> +
>  /*
>   * Direct Memory Access Controller (DMAC)
>   */
> @@ -1262,7 +1273,5 @@
>   */
>  #define SH7750_BCR3_A7       0x1f800050
>  #define SH7750_BCR4_A7       0x1e0a00f0
> -#define SH7750_PRECHARGE0_A7 0x1f900088
> -#define SH7750_PRECHARGE1_A7 0x1f940088
>  
>  #endif
> diff --git a/target-sh4/cpu.h b/target-sh4/cpu.h
> index 226417f..da6b81c 100644
> --- a/target-sh4/cpu.h
> +++ b/target-sh4/cpu.h
> @@ -95,6 +95,7 @@ typedef struct tlb_t {
>  
>  enum sh_features {
>      SH_FEATURE_SH4A = 1,
> +    SH_FEATURE_BCR3_AND_BCR4 = 2,
>  };
>  
>  typedef struct CPUSH4State {
> diff --git a/target-sh4/translate.c b/target-sh4/translate.c
> index 2d3981c..ed4a26b 100644
> --- a/target-sh4/translate.c
> +++ b/target-sh4/translate.c
> @@ -217,12 +217,14 @@ static sh4_def_t sh4_defs[] = {
>  	.pvr = 0x00050000,
>  	.prr = 0x00000100,
>  	.cvr = 0x00110000,
> +	.features = SH_FEATURE_BCR3_AND_BCR4,
>      }, {
>  	.name = "SH7751R",
>  	.id = SH_CPU_SH7751R,
>  	.pvr = 0x04050005,
>  	.prr = 0x00000113,
>  	.cvr = 0x00110000,	/* Neutered caches, should be 0x20480000 */
> +	.features = SH_FEATURE_BCR3_AND_BCR4,
>      }, {
>  	.name = "SH7785",
>  	.id = SH_CPU_SH7785,
> -- 
> 1.5.6.5
> 
> 
> 
> 

-- 
  .''`.  Aurelien Jarno	            | GPG: 1024D/F1BCDB73
 : :' :  Debian developer           | Electrical Engineer
 `. `'   aurel32@debian.org         | aurelien@aurel32.net
   `-    people.debian.org/~aurel32 | www.aurel32.net