' TassyJim Jun2020
 ' PS2 mouse to serial interface demo
 ' Arduino sends 3 bytes
 ' X movement - signed byte,Y movement - signed byte,Button states - byte
 ' for micromites that don't do sprites, comment out those lines.
 ' Maximite running V4.5 will have to change the CIRCLE and TEXT commands
 ' early Maximites will also need to change Colour and INTEGER
 
 DIM INTEGER mouseX, mouseY, mouseB, mouseR, mouseL, mouseM  ' mouse position and buttons
 DIM INTEGER mouseMove, mouseClick ' flags to indicate mouse movement or button change
 DIM INTEGER mc ' mouse colour
 
 SPRITE LOAD "mouse.spr",5
 OPEN "com1: 19200,256,mousetrap,3" AS #2 ' 19200 is the fastest that all Maximie/micromites can handle
 initM
 
 DO
   IF INKEY$ = " " THEN initM ' might be needed if the mouse interface is interrupted.
   
   IF mouseMove = 1 THEN
     IF mouseX < 0 THEN mouseX = 0 ' keep the pionter on the screen
     IF mouseY < 0 THEN mouseY = 0
     IF mouseX >= MM.HRES THEN mouseX = MM.HRES -1
     IF mouseY >= MM.VRES THEN mouseY = MM.VRES -1
     drawIt
     mouseMove = 0
   ENDIF
   
   IF mouseClick = 1 THEN
     mouseR = (mouseB AND 2)/2 ' extract the individual button states
     mouseL = (mouseB AND 1)
     mouseM = (mouseB AND 4)/4
     IF mouseL = 1 THEN mc = RGB(RED)
     IF mouseR = 1 THEN mc = RGB(GREEN)
     IF mouseL = 1 AND mouseR = 1 THEN mc = RGB(BLUE)
     drawIt
     mouseClick = 0
   ENDIF
 LOOP
 
 CLOSE #2
 
SUB initM
 LOCAL j$
 j$ = INPUT$(255,#2) ' flush the serial buffer
 mouseX = MM.HRES/2
 mouseY = MM.VRES/2
 CLS
 SPRITE SHOW 5,mouseX,mouseY,1
END SUB
 
SUB drawIt
 TEXT 10,10, STR$(mouseX)+" "+STR$(mouseY)+" "+STR$(mouseL)+" "+STR$(mouseM)+" "+STR$(mouseR)
 SPRITE HIDE 5 ' hide the cursor while we draw
 IF (mouseL + mouseR) > 0 THEN ' only draw if a button is pressed
   CIRCLE mouseX, mouseY, 3, 1,1,mc,mc
   'circle(mouseX, mouseY),3,mc,1,F ' CMM V1
 ENDIF
 SPRITE SHOW 5,mouseX,mouseY,1
END SUB
 
SUB mousetrap
 LOCAL INTEGER deltaB, deltaX, deltaY
 deltaX = ASC(INPUT$(1,#2))  ' read 3 bytes
 deltaY = ASC(INPUT$(1,#2))
 deltaB = ASC(INPUT$(1,#2)) AND 7
 IF deltaX > 127 THEN deltaX = deltaX - 256 ' signed 8 bit integer
 IF deltaY > 127 THEN deltaY = deltaY - 256
 IF mouseB <> deltaB THEN    '  buttons have changed
   mouseClick = 1            ' set the flag
   mouseB = deltaB           ' remember button states
 ENDIF
 IF deltaX <>0 OR deltaY <> 0 THEN  ' mouse has moved
   mouseMove = 1             ' set the flag
   mouseX = mouseX + deltaX
   mouseY = mouseY - deltaY
 ENDIF
END SUB
 

/*
 PS2 mouse to serial
 PS2 clock = pin 6
 PS2 data  = pin 5
 Time taken to read the mouse approx 13mS
 1 mS to send data at 38400 baud
*/

#include "PS2Mouse.h"

PS2Mouse mouse(6,5);

void setup(){
 Serial.begin(19200);
 /*
 while(!Serial);
 Serial.print("Setup... ");
*/
 mouse.begin();
 /*
 Serial.println("complete!");
 */
}

void loop(){
 uint8_t stat;
 int x,y;
 mouse.getPosition(stat,x,y);
 Serial.write(x);
 Serial.write(y);
 Serial.write(stat);
 delay(100);  
}

SUB mousetrap
 LOCAL INTEGER deltaB, deltaX, deltaY, device
 deltaB = ASC(INPUT$(1,#2))  ' read 3 bytes
 deltaX = ASC(INPUT$(1,#2))
 deltaY = ASC(INPUT$(1,#2))
 device = (deltaB AND 192 )/ 64  'top 2 bits determine devcie sending data
 IF device = 0 THEN ' its a mouse
   PRINT "Mouse "; STR$(deltaX,6,0);STR$(deltaY,6,0);"  ";BIN$(deltaB,8) 'DEBUG
   deltaB = deltaB AND 7
   IF deltaX > 127 THEN deltaX = deltaX - 256 ' signed 8 bit integer
   IF deltaY > 127 THEN deltaY = deltaY - 256
   IF mouseB <> deltaB THEN    '  buttons have changed
     mouseClick = 1            ' set the flag
     mouseB = deltaB           ' remember button states
   ENDIF
   IF deltaX <>0 OR deltaY <> 0 THEN  ' mouse has moved
     mouseMove = 1             ' set the flag
     mouseX = mouseX + deltaX
     mouseY = mouseY - deltaY
   ENDIF
 ELSEIF device = 1 THEN ' its joystick A
   deltaX = deltaX + (deltaB AND &B00110000)*16
   deltaY = deltaY + (deltaB AND &B00001100)*64
   PRINT "Joy A "; STR$(deltaX,6,0);STR$(deltaY,6,0);"  ";BIN$(deltaB,8) 'DEBUG
 ELSEIF device = 2 THEN ' its joystick B
   deltaX = deltaX + (deltaB AND &B00110000)*16
   deltaY = deltaY + (deltaB AND &B00001100)*64
   PRINT "Joy B "; STR$(deltaX,6,0);STR$(deltaY,6,0);"  ";BIN$(deltaB,8) 'DEBUG
 ENDIF
 PRINT
END SUB
 

/*
 PS2 mouse to serial
 PS2 clock = pin 3
 PS2 data  = pin 2
 Time taken to read the mouse approx 13mS
 1 mS to send data at 38400 baud
*/

#include "PS2Mouse.h"


const int trigPin = 4;
const int axPin = 5;
const int ayPin = 6;
const int bxPin = 7;
const int byPin = 8;
const int ab1Pin = 9;
const int ab2Pin = 10;
const int bb1Pin = 11;
const int bb2Pin = 12;

 uint8_t stat;
 int x,y,s,so;
unsigned long timeZero, timeWait;
signed long axt,ayt,bxt,byt;
signed long axto,ayto,bxto,byto;
int p,ab,bb, abo,bbo;
PS2Mouse mouse(3,2);
 
void setup(){
 Serial.begin(19200);
 pinMode(axPin, INPUT);
 pinMode(ayPin, INPUT);
 pinMode(bxPin, INPUT);
 pinMode(byPin, INPUT);
 pinMode(ab1Pin, INPUT_PULLUP);
 pinMode(ab2Pin, INPUT_PULLUP);
 pinMode(bb1Pin, INPUT_PULLUP);
 pinMode(bb2Pin, INPUT_PULLUP);
 
 pinMode(trigPin, OUTPUT);
 digitalWrite(trigPin, LOW);

 mouse.begin();

}

void loop(){

 mouse.getPosition(stat,x,y);
 s = stat & 0x3F;        //make sure the top 2 bits are zero
 if(x != 0 || y != 0 || s != so){
   Serial.write(s);
   Serial.write(x);
   Serial.write(y);
   so = s;
 }
 axt = 0;
 ayt = 0;
 bxt = 0;
 byt = 0;
 
 digitalWrite(trigPin, HIGH); // discharge the capacitors
 delayMicroseconds(100);
 digitalWrite(trigPin, LOW);
 timeZero = micros();
 timeWait = timeZero + 2050; // set timeout

 while (micros() < timeWait) {
   if (axt == 0 && digitalRead(axPin) == LOW) {
     axt = micros()-timeZero;
   }
   if (ayt == 0 && digitalRead(ayPin) == LOW){
     ayt = micros()-timeZero;
   }
   if (bxt == 0 && digitalRead(bxPin) == LOW){
     bxt = micros()-timeZero;
   }
   if (byt == 0 && digitalRead(byPin) == LOW){
     byt = micros()-timeZero;
   }
 }
 /* nano only has 4 uS resolution so divide by 4
    add high byte bits to button byte
   2 bits to identify mouse or joystick, 2 bits for x axis,
   2 bits for y axis 2 bits for buttons
 */
 axt = axt / 4;
 ayt = ayt / 4;
 bxt = bxt / 4;
 byt = byt / 4;
 ab = (highByte(axt) & 3 )*16 + (highByte(ayt) & 3 )*4 + 64;
 ab = ab + (1-digitalRead(ab2Pin)) *2;
 ab = ab + 1-digitalRead(ab1Pin);
 
 bb = (highByte(bxt) & 3 )*16 + (highByte(byt) & 3 )*4 + 128;
 bb = bb + (1-digitalRead(bb2Pin)) *2;
 bb = bb + 1-digitalRead(bb1Pin);

 if (ab != abo || axt != axto || ayt != ayto) {
   Serial.write(ab);
   Serial.write(lowByte(axt));
   Serial.write(lowByte(ayt));
   abo = ab;
   axto = axt;
   ayto = ayt;
 }
 delay(3);    // give the micromite time to digest
 if (bb != bbo || bxt != bxto || byt != byto) {
   Serial.write(bb);
   Serial.write(lowByte(bxt));
   Serial.write(lowByte(byt));
   bbo = bb;
   bxto = bxt;
   byto = byt;
 }
 
 delay(1000);  
}

Joy B     81     0  10000000
Joy B     80     0  10000000
Joy A    136   142  01000000
Joy A    138   144  01000000
Joy B     81     0  10000000
Joy A    137   144  01000000
Joy B     80     0  10000000
Joy A    136   143  01000000
Joy A    138   144  01000000
Joy B     82     0  10000000
Joy A    136   143  01000000
Joy B     80     0  10000000
Joy A    136   142  01000000