[flashrom] [PATCH 1/5] rayer_spi: Create list of programmer types

[Kyösti Mälkki]

Signed-off-by: Kyösti Mälkki 
---
 rayer_spi.c | 106 ++++++++++++++++++++++++++++++++++--------------------------
 1 file changed, 61 insertions(+), 45 deletions(-)

diff --git a/rayer_spi.c b/rayer_spi.c
index b312610..b4ef205 100644
--- a/rayer_spi.c
+++ b/rayer_spi.c
@@ -37,21 +37,48 @@
 #include "programmer.h"
 #include "hwaccess.h"

-enum rayer_type {
-	TYPE_RAYER,
-	TYPE_XILINX_DLC5,
-};
-
 /* We have two sets of pins, out and in. The numbers for both sets are
  * independent and are bitshift values, not real pin numbers.
  * Default settings are for the RayeR hardware.
  */
-/* Pins for master->slave direction */
-static int rayer_cs_bit = 5;
-static int rayer_sck_bit = 6;
-static int rayer_mosi_bit = 7;
-/* Pins for slave->master direction */
-static int rayer_miso_bit = 6;
+
+struct rayer_programmer {
+	const char * type;
+	const enum test_state status;
+	const char * description;
+	const void * private;
+};
+
+struct rayer_pinout {
+	int cs_bit;
+	int sck_bit;
+	int mosi_bit;
+	int miso_bit;
+	void (*preinit)(void *);
+	int (*shutdown)(void *);
+};
+
+static struct rayer_pinout rayer_spipgm = {
+	.cs_bit = 5,
+	.sck_bit = 6,
+	.mosi_bit = 7,
+	.miso_bit = 6,
+};
+
+static struct rayer_pinout xilinx_dlc5 = {
+	.cs_bit = 2,
+	.sck_bit = 1,
+	.mosi_bit = 0,
+	.miso_bit = 4,
+};
+
+struct rayer_programmer rayer_spi_types[] = {
+	{"rayer",	NT,	"RayeR SPIPGM",			  	&rayer_spipgm},
+	{"xilinx",	NT,	"Xilinx Parallel Cable III (DLC 5)", 	&xilinx_dlc5},
+	{0},
+};
+
+struct rayer_pinout *pinout = NULL;

static uint16_t lpt_iobase;

@@ -60,22 +87,22 @@ static uint8_t lpt_outbyte;

static void rayer_bitbang_set_cs(int val)
 {
-	lpt_outbyte &= ~(1 << rayer_cs_bit);
-	lpt_outbyte |= (val << rayer_cs_bit);
+	lpt_outbyte &= ~(1 << pinout->cs_bit);
+	lpt_outbyte |= (val << pinout->cs_bit);
    OUTB(lpt_outbyte, lpt_iobase);
 }

static void rayer_bitbang_set_sck(int val)
 {
-	lpt_outbyte &= ~(1 << rayer_sck_bit);
-	lpt_outbyte |= (val << rayer_sck_bit);
+	lpt_outbyte &= ~(1 << pinout->sck_bit);
+	lpt_outbyte |= (val << pinout->sck_bit);
    OUTB(lpt_outbyte, lpt_iobase);
 }

static void rayer_bitbang_set_mosi(int val)
 {
-	lpt_outbyte &= ~(1 << rayer_mosi_bit);
-	lpt_outbyte |= (val << rayer_mosi_bit);
+	lpt_outbyte &= ~(1 << pinout->mosi_bit);
+	lpt_outbyte |= (val << pinout->mosi_bit);
    OUTB(lpt_outbyte, lpt_iobase);
 }

@@ -83,8 +110,8 @@ static int rayer_bitbang_get_miso(void)
 {
    uint8_t tmp;

-	tmp = INB(lpt_iobase + 1);
-	tmp = (tmp >> rayer_miso_bit) & 0x1;
+	tmp = INB(lpt_iobase + 1) ^ 0x80; // bit.7 inverted
+	tmp = (tmp >> pinout->miso_bit) & 0x1;
    return tmp;
 }

@@ -99,8 +126,8 @@ static const struct bitbang_spi_master bitbang_spi_master_rayer = {

int rayer_spi_init(void)
 {
+	struct rayer_programmer *prog = rayer_spi_types;
    char *arg = NULL;
-	enum rayer_type rayer_type = TYPE_RAYER;

/* Non-default port requested? */
    arg = extract_programmer_param("iobase");
@@ -138,36 +165,20 @@ int rayer_spi_init(void)

arg = extract_programmer_param("type");
    if (arg) {
-		if (!strcasecmp(arg, "rayer")) {
-			rayer_type = TYPE_RAYER;
-		} else if (!strcasecmp(arg, "xilinx")) {
-			rayer_type = TYPE_XILINX_DLC5;
-		} else {
+		for (; prog->type; ++prog) {
+			if (! strcasecmp (arg, prog->type)) {
+				break;
+			}
+		}
+		if(! prog->type) {
    		msg_perr("Error: Invalid device type specified.\n");
    		free(arg);
    		return 1;
    	}
+		free(arg);
    }
-	free(arg);
-	switch (rayer_type) {
-	case TYPE_RAYER:
-		msg_pdbg("Using RayeR SPIPGM pinout.\n");
-		/* Bits for master->slave direction */
-		rayer_cs_bit = 5;
-		rayer_sck_bit = 6;
-		rayer_mosi_bit = 7;
-		/* Bits for slave->master direction */
-		rayer_miso_bit = 6;
-		break;
-	case TYPE_XILINX_DLC5:
-		msg_pdbg("Using Xilinx Parallel Cable III (DLC 5) pinout.\n");
-		/* Bits for master->slave direction */
-		rayer_cs_bit = 2;
-		rayer_sck_bit = 1;
-		rayer_mosi_bit = 0;
-		/* Bits for slave->master direction */
-		rayer_miso_bit = 4;
-	}
+	msg_pinfo("Using %s pinout.\n", prog->description);
+	pinout = (struct rayer_pinout *) prog->private;

if (rget_io_perms())
    	return 1;
@@ -175,6 +186,11 @@ int rayer_spi_init(void)
    /* Get the initial value before writing to any line. */
    lpt_outbyte = INB(lpt_iobase);

+	if (pinout->shutdown)
+		register_shutdown(pinout->shutdown, (void*)pinout);
+	if (pinout->preinit)
+		pinout->preinit(pinout);
+
    if (bitbang_spi_init(&bitbang_spi_master_rayer))
    	return 1;