From 178968cc2fc4c32fb918ebb4ccd24d78b64cd73f Mon Sep 17 00:00:00 2001
From: Javier Degirolmo
Date: Fri, 7 Oct 2011 12:17:54 -0300
Subject: Initial upload, Echo 0.8 UNSTABLE VERSION

---
 src-68k/input/joypad.68k | 43 +++++++++++++++++++++++++++++++++++++++++++
 1 file changed, 43 insertions(+)
 create mode 100644 src-68k/input/joypad.68k

(limited to 'src-68k/input/joypad.68k')

diff --git a/src-68k/input/joypad.68k b/src-68k/input/joypad.68k
new file mode 100644
index 0000000..f33d000
--- /dev/null
+++ b/src-68k/input/joypad.68k
@@ -0,0 +1,43 @@
+;****************************************************************************
+; InitJoypad
+; Initializes the joypad
+;****************************************************************************
+
+InitJoypad:
+    move.b  #$40, ($A10009)         ; Initialize I/O ports
+    move.b  #$40, ($A10003)
+    move.w  #0, (RAM_JoyHold)       ; Initialize status
+    rts                             ; End of subroutine
+
+;****************************************************************************
+; ReadJoypad
+; Reads the joypad status
+;****************************************************************************
+
+ReadJoypad:
+    lea     ($A10003), a6           ; I/O data port
+
+    move.b  #$40, (a6)              ; Read D-pad, B and C
+    nop
+    nop
+    move.b  (a6), d7
+    move.b  #$00, (a6)              ; Read A and Start
+    nop
+    nop
+    move.b  (a6), d6
+
+    and.b   #$3F, d7                ; Process input
+    and.b   #$30, d6
+    add.b   d6, d6
+    add.b   d6, d6
+    or.b    d6, d7
+    not.b   d7
+
+    lea     (RAM_JoyHold), a6       ; Store new joypad status
+    move.b  (a6), d6
+    move.b  d7, (a6)+
+    not.b   d6
+    and.b   d6, d7
+    move.b  d7, (a6)
+
+    rts                             ; End of subroutine
-- 
cgit v1.2.3