From d8be8ac116d2187c97a53af51a85364990418b46 Mon Sep 17 00:00:00 2001
From: =?UTF-8?q?Arnim=20L=C3=A4uger?= <arniml@users.sourceforge.net>
Date: Mon, 15 Jun 2009 20:16:43 +0000
Subject: [PATCH] experimental support for x16 mode

git-svn-id: https://urjtag.svn.sourceforge.net/svnroot/urjtag/trunk@1652 b68d4a1b-bc3d-0410-92ed-d4ac073336b7
---
 urjtag/ChangeLog         |  4 ++++
 urjtag/src/bus/mpc824x.c | 17 ++++++++++++++++-
 2 files changed, 20 insertions(+), 1 deletion(-)

diff --git a/urjtag/ChangeLog b/urjtag/ChangeLog
index 50a17cb8..6df72e4c 100644
--- a/urjtag/ChangeLog
+++ b/urjtag/ChangeLog
@@ -1,3 +1,7 @@
+2009-06-15  Arnim Laeuger  <arniml>
+
+  * src/bus/mpc824x.c: experimental support for x16 mode
+
 2009-06-13  Rutger Hofman <rfhh>
 
   * include/urjtag/*.h: change all struct/enum definitions from
diff --git a/urjtag/src/bus/mpc824x.c b/urjtag/src/bus/mpc824x.c
index 0d9b6e11..2478af0e 100644
--- a/urjtag/src/bus/mpc824x.c
+++ b/urjtag/src/bus/mpc824x.c
@@ -101,6 +101,10 @@ mpc824x_bus_new (urj_chain_t *chain, const urj_bus_driver_t *driver,
                 BUS_WIDTH = 8;
                 dfltWidth = 0;
                 break;
+            case 16:
+                BUS_WIDTH = 16;
+                dfltWidth = 0;
+                break;
             case 32:
                 BUS_WIDTH = 32;
                 dfltWidth = 0;
@@ -114,7 +118,7 @@ mpc824x_bus_new (urj_chain_t *chain, const urj_bus_driver_t *driver,
                 break;
             default:
                 urj_error_set (URJ_ERROR_UNSUPPORTED,
-                               _("   Only 8,32 and 64 bus width are supported for Banks 0 and 1"));
+                               _("   Only 8, 16, 32 and 64 bus width are supported for Banks 0 and 1"));
                 return NULL;
             }
             break;
@@ -314,6 +318,10 @@ setup_address (urj_bus_t *bus, uint32_t a)
         for (i = 0; i < 23; i++)
             urj_part_set_signal (p, AR[i], 1, (a >> i) & 1);
         break;
+    case 16:                   /* 16-bit data bus */
+        for (i = 0; i < 22; i++)
+            urj_part_set_signal (p, AR[i], 1, (a >> (i + 1)) & 1);
+        break;
     case 32:                   /* 32-bit data bus */
         for (i = 0; i < 21; i++)
             urj_part_set_signal (p, AR[i], 1, (a >> (i + 2)) & 1);
@@ -337,6 +345,9 @@ setup_address (urj_bus_t *bus, uint32_t a)
         case 8:
             k = 23;
             break;
+        case 16:
+            k = 22;
+            break;
         case 32:
             k = 21;
             break;
@@ -403,6 +414,8 @@ setup_data (urj_bus_t *bus, uint32_t adr, uint32_t d)
         int bytes = 0;
         if (BUS_WIDTH == 8)
             bytes = 1;
+        else if (BUS_WIDTH == 16)
+            bytes = 2;
         else if (BUS_WIDTH == 32)
             bytes = 4;
         else if (BUS_WIDTH == 64)
@@ -449,6 +462,8 @@ get_data (urj_bus_t *bus, uint32_t adr)
         int bytes = 0;
         if (BUS_WIDTH == 8)
             bytes = 1;
+        else if (BUS_WIDTH == 16)
+            bytes = 2;
         else if (BUS_WIDTH == 32)
             bytes = 4;
         else if (BUS_WIDTH == 64)