1 files changed, 4 insertions, 11 deletions

@@ -12,9 +12,9 @@
 
 void initializeLink()
 {
-  REG_HS_CTRL |= JOY_RW;
   REG_JOYTR = 0;
-  while ((REG_HS_CTRL & JOY_WRITE) == 0);
+  REG_HS_CTRL |= JOY_RW;
+  while ((REG_HS_CTRL & JOY_READ) == 0);
   REG_HS_CTRL |= JOY_RW;
 }
 
@@ -22,29 +22,22 @@ void waitForAck()
 {
   while ((REG_HS_CTRL & JOY_WRITE) == 0);
   REG_HS_CTRL |= JOY_RW;
-  REG_JOYTR = 0;
-  while ((REG_HS_CTRL & JOY_WRITE) == 0);
-  REG_HS_CTRL |= JOY_RW;
 }
 
 u32 waitForResponse()
 {
   u32 val;
 
-  REG_JOYTR = 1;
-  while ((REG_HS_CTRL & JOY_WRITE) == 0);
-  val = REG_JOYRE;
-  REG_HS_CTRL |= JOY_RW;
-  REG_JOYTR = 0;
   while ((REG_HS_CTRL & JOY_WRITE) == 0);
   REG_HS_CTRL |= JOY_RW;
+  val = REG_JOYRE;
 
   return val;
 }
 
 void sendS32(s32 val)
 {
-  REG_JOYTR = val;
+  sendU32(val);
 }
 
 void sendU32(u32 val)