/*
 * Routines to access the MAverickCrunch DSPSC FPU control register
 * as used in Cirrus Logic EP93xx chips.
 *
 * cc -mcpu=ep9312 -mfpu=maverick and -mfloat-abi=softfp if using EABI.
 *
 * Martin Guy <martinwguy@yahoo.it> 5 Oct 2007 - 22 Mar 2009
 */

#include <stdio.h>

/* Contents of Maverick Crunch DSPSC register in little-endian mode.
 * See EP9307 Users Guide, Chapter 2 */
struct DSPSC {
#define u unsigned
	u IO:1; u RSVD1:1; u OF:1; u UF:1; u IX:1; u IOE:1; u RSVD6:1; u OFE:1;
	u UFE:1; u IXE:1; u RM:2; u Denorm:1; u Invalid:1; u FWDEN:1; u V:1;
	u FCC:2; u SAT:2; u AEXC:1; u INT:1; u UI:1; u ISAT:1;
	u RSVD24:2; u HVID:3; u DAID:3;
	u INST:32;
#undef u
} dspsc;

/* Single bit fields are DSPSC_FOO */
/* Multi-bit fields are DSPSC_FOO_MASK */
#define DSPSC_IO	0x00000001
#define DSPSC_OF	0x00000004
#define DSPSC_UF	0x00000008
#define DSPSC_IX	0x00000010
#define DSPSC_IOE	0x00000020
#define DSPSC_OFE	0x00000080
#define DSPSC_UFE	0x00000100
#define DSPSC_IXE	0x00000200
#define DSPSC_RM_MASK 	0x00000C00
#define DSPSC_Denorm	0x00001000
#define DSPSC_Invalid	0x00002000
#define DSPSC_FWDEN	0x00004000
#define DSPSC_V		0x00008000
#define DSPSC_FCC_MASK	0x00030000
#define DSPSC_SAT_MASK	0x000C0000
#define DSPSC_AEXC	0x00100000
#define DSPSC_INT	0x00200000
#define DSPSC_ISAT	0x00400000
#define DSPSC_HVID_MASK	0x01C00000
#define DSPSC_DAID_MASK	0xE0000000

static void read_dspsc(void);
static void write_dspsc(void);
static void print_dspsc(void);

/* Just set the ISAT bit */
static void
dspsc_set_isat()
{
	asm("cfmv32sc   mvdx0, dspsc");         /* Get DSPSC contents */
	asm("cfmvrdl	r0, mvd0");		/* Put lower 32 in ARM reg */
	asm("orr	r0, r0, #0x0800");	/* Set bit 23 (ISAT) */
	asm("cfmvdlr	mvd0, r0");		/* Copy back to 64-bit reg */
	asm("cfmvsc32	dspsc, mvdx0");		/* Write to DSPSC */
}

/* Print the contents of the structure in human-readable form */
static void
print_dspsc()
{
#define d dspsc
	printf("INST=0x%08x\n", d.INST);
	printf("DAID=%d HVID=%d ISAT=%d UI=%d INT=%d AEXC=%d SAT=%d\n",
	      d.DAID, d.HVID, d.ISAT, d.UI, d.INT, d.AEXC, d.SAT);
	printf("FCC=%d V=%d FWDEN=%d Invalid=%d Denorm=%d RM=%d\n",
	      d.FCC, d.V, d.FWDEN, d.Invalid, d.Denorm, d.RM);
	printf("IXE=%d UFE=%d OFE=%d IOE=%d IX=%d UF=%d OF=%d IO=%d\n",
	      d.IXE, d.UFE, d.OFE, d.IOE, d.IX, d.UF, d.OF, d.IO);
#undef d
}

/* Copy register contents into our structure */
void
read_dspsc()
{
	/* If you put the ldr after the cfmv32sc, you can
	 * trigger an undocumented Maverick hardware bug, whereby
	 * ldr rN, foo; cfstr64 mvdX, [rN] corrupts memory at random.
	 * (Tested on Rev E1 hardware).
	 */
	asm("ldr	r3, =dspsc");		/* Get address of dspsc */
	asm("cfmv32sc	mvdx0, dspsc");		/* Get DSPSC contents */
	asm("cfstr64	mvdx0, [r3]"); /* Store dspcc contents in dspsc */
}

/* Copy our structure's contents into the register */
void
write_dspsc()
{
	asm("ldr	r0, =dspsc");		/* Get address of dspsc */
	/* no-op to workaround Maverick timing bug: cfldr64 must not busy-wait.
	 * Without this, rubbish is written into all 64 bits of DSPSC.
	 * (Erratum 3, tested on Rev E1 hardware)
	 */
	asm("nop");
	asm("cfldr64	mvdx0, [r0]");		/* Read our variable into c0 */
	asm("cfmvsc32	dspsc, mvdx0");		/* Write to dspcc */
}
