From 29ea34d2b6a66e34621b1e71e6a677ba3463e3a5 Mon Sep 17 00:00:00 2001
From: Marcel Telka <marcel@telka.sk>
Date: Thu, 24 Oct 2002 12:34:44 +0000
Subject: [PATCH] Added PXA250 bus operations.

git-svn-id: https://urjtag.svn.sourceforge.net/svnroot/urjtag/trunk@206 b68d4a1b-bc3d-0410-92ed-d4ac073336b7
---
 jtag/src/pxa250.c | 129 ++++++++++++++++++++++++++++++++++++++++++++++
 1 file changed, 129 insertions(+)
 create mode 100644 jtag/src/pxa250.c

diff --git a/jtag/src/pxa250.c b/jtag/src/pxa250.c
new file mode 100644
index 00000000..264d41fc
--- /dev/null
+++ b/jtag/src/pxa250.c
@@ -0,0 +1,129 @@
+/*
+ * $Id$
+ *
+ * Copyright (C) 2002 ETC s.r.o.
+ *
+ * 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
+ * of the License, or (at your option) any later version.
+ *
+ * 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.
+ *
+ * Written by Marcel Telka <marcel@telka.sk>, 2002.
+ *
+ */
+
+#include <stdint.h>
+
+#include "part.h"
+
+#include "pxa250.h"
+
+/* PXA250 must be in position 0 */
+
+static void
+setup_address( part *p, uint32_t a )
+{
+	int i;
+	char buff[10];
+
+	for (i = 0; i < 26; i++) {
+		sprintf( buff, "MA[%d]", i );
+		part_set_signal( p, buff, 1, (a >> i) & 1 );
+	}
+}
+
+static void
+set_data_in( part *p )
+{
+	int i;
+	char buff[10];
+
+	for (i = 0; i < 32; i++) {
+		sprintf( buff, "MD[%d]", i );
+		part_set_signal( p, buff, 0, 0 );
+	}
+}
+
+static void
+setup_data( part *p, uint32_t d )
+{
+	int i;
+	char buff[10];
+
+	for (i = 0; i < 32; i++) {
+		sprintf( buff, "MD[%d]", i );
+		part_set_signal( p, buff, 1, (d >> i) & 1 );
+	}
+}
+
+uint32_t
+pxa250_bus_read( parts *ps, uint32_t adr )
+{
+	part *p = ps->parts[0];
+
+	part_set_signal( p, "nCS[0]", 1, 0 );
+	part_set_signal( p, "DQM[0]", 1, 0 );
+	part_set_signal( p, "DQM[1]", 1, 0 );
+	part_set_signal( p, "DQM[2]", 1, 0 );
+	part_set_signal( p, "DQM[3]", 1, 0 );
+	part_set_signal( p, "RDnWR", 1, 1 );
+	part_set_signal( p, "nWE", 1, 1 );
+	part_set_signal( p, "nOE", 1, 0 );
+	part_set_signal( p, "nSDCAS", 1, 0 );
+
+	setup_address( p, adr );
+	set_data_in( p );
+
+	parts_shift_data_registers( ps );
+	parts_shift_data_registers( ps );
+
+	{
+		int i;
+		char buff[10];
+		uint32_t d = 0;
+
+		for (i = 0; i < 32; i++) {
+			sprintf( buff, "MD[%d]", i );
+			d |= (uint32_t) (part_get_signal( p, buff ) << i);
+		}
+
+		return d;
+	}
+}
+
+void
+pxa250_bus_write( parts *ps, uint32_t adr, uint32_t data )
+{
+	/* see Figure 6-17 in PXA doc */
+	part *p = ps->parts[0];
+
+	part_set_signal( p, "nCS[0]", 1, 0 );
+	part_set_signal( p, "DQM[0]", 1, 0 );
+	part_set_signal( p, "DQM[1]", 1, 0 );
+	part_set_signal( p, "DQM[2]", 1, 0 );
+	part_set_signal( p, "DQM[3]", 1, 0 );
+	part_set_signal( p, "RDnWR", 1, 0 );
+	part_set_signal( p, "nWE", 1, 1 );
+	part_set_signal( p, "nOE", 1, 1 );
+	part_set_signal( p, "nSDCAS", 1, 0 );
+
+	setup_address( p, adr );
+	setup_data( p, data );
+
+	parts_shift_data_registers( ps );
+
+	part_set_signal( p, "nWE", 1, 0 );
+	parts_shift_data_registers( ps );
+	part_set_signal( p, "nWE", 1, 1 );
+	parts_shift_data_registers( ps );
+}