61	switch (port)
62	{
63		case 0x201: //Fire joystick four one-shots?
64			//Set timeoutx and timeouty based on the relative status of Joystick_X and Joystick_Y to fully left/top!
65			//First joystick timeout!
66			if (JOYSTICK.timeoutx[1]<=0.0)
67			{
68				JOYSTICK.timeoutx[1] = CALCTIMEOUT(JOYSTICK.Joystick_X[1]+(-SHRT_MIN));
69			}
70			if (JOYSTICK.timeouty[1]<=0.0)
71			{
72				JOYSTICK.timeouty[1] = CALCTIMEOUT(JOYSTICK.Joystick_Y[1]+(-SHRT_MIN));
73			}
74			//Second joystick timeout!
75			if (JOYSTICK.timeoutx[0] <= 0.0)
76			{
77				JOYSTICK.timeoutx[0] = CALCTIMEOUT(JOYSTICK.Joystick_X[0]+(-SHRT_MIN));
78			}
79			if (JOYSTICK.timeouty[0] <= 0.0)
80			{
81				JOYSTICK.timeouty[0] = CALCTIMEOUT(JOYSTICK.Joystick_Y[0]+(-SHRT_MIN));
82			}
83			return 1; //OK!
84		default:
85			break;
86	}
87	return 0; //Not an used port!
88}
89
90void joystickInit()
91{
92	register_PORTIN(&joystick_readIO); //Register our handler!
93	register_PORTOUT(&joystick_writeIO); //Register our handler!
94	JOYSTICK.timeoutx[0] = JOYSTICK.timeouty[0] = JOYSTICK.timeoutx[1] = JOYSTICK.timeouty[1] = 0.0; //Init timeout!
95}

61			JOYSTICK.timeouty[1] -= timepassed; //Add the time to what's left!
62			if (JOYSTICK.timeouty[1]<=0.0) //Finished timing?
63			{
64				JOYSTICK.timeout &= ~8; //Finished timing, go logic 1(digital 0)!
65			}
66		}
67	}
68}
69
70byte joystick_readIO(word port, byte *result)
71{
72	INLINEREGISTER byte temp;
73	switch (port)
74	{
75		case 0x201: //Read joystick position and status?
76			//bits 8-7 are joystick B buttons 2/1, Bits 6-5 are joystick A buttons 2/1, bit 4-3 are joystick B Y-X timeout timing, bits 1-0 are joystick A Y-X timeout timing.
77			temp = (JOYSTICK.buttons[1]<<6); //Not pressed joystick B?
78			temp |= (JOYSTICK.buttons[0]<<4); //Not pressed joystick A?
79			temp |= JOYSTICK.timeout; //Timed out?
80			*result = temp; //Give the result!
81			return 1; //OK!
82		default:
83			break;
84	}
85	return 0; //Not an used port!
86}
87
88byte joystick_writeIO(word port, byte value)
89{
90	switch (port)
91	{
92		case 0x201: //Fire joystick four one-shots?
93			//Set timeoutx and timeouty based on the relative status of Joystick_X and Joystick_Y to fully left/top!
94			//First joystick timeout!
95			JOYSTICK.timeoutx[1] = CALCTIMEOUT((int_32)JOYSTICK.Joystick_X[1]-SHRT_MIN);
96			JOYSTICK.timeouty[1] = CALCTIMEOUT((int_32)JOYSTICK.Joystick_Y[1]-SHRT_MIN);
97			//Second joystick timeout!
98			JOYSTICK.timeoutx[0] = CALCTIMEOUT((int_32)JOYSTICK.Joystick_X[0]-SHRT_MIN);
99			JOYSTICK.timeouty[0] = CALCTIMEOUT((int_32)JOYSTICK.Joystick_Y[0]-SHRT_MIN);
100			JOYSTICK.timeout = 0xF; //Start the timeout on all channels. Multivibrator output goes to logic 0.
101			return 1; //OK!
102		default:
103			break;
104	}
105	return 0; //Not an used port!
106}
107
108void joystickInit()
109{
110	register_PORTIN(&joystick_readIO); //Register our handler!
111	register_PORTOUT(&joystick_writeIO); //Register our handler!
112	JOYSTICK.buttons[0] = JOYSTICK.buttons[1] = 3; //Not pressed!
113	JOYSTICK.timeoutx[0] = JOYSTICK.timeouty[0] = JOYSTICK.timeoutx[1] = JOYSTICK.timeouty[1] = 0.0; //Init timeout to nothing!
114	JOYSTICK.timeout = 0x0; //Default: all lines timed out!
115}

61	JOYSTICK.buttons[joystick] = (button2?0x0:0x2)|(button1?0x0:0x1); //Button 1&2, not pressed!
62	JOYSTICK.Joystick_X[joystick] = analog_x; //Joystick x axis!
63	JOYSTICK.Joystick_Y[joystick] = analog_y; //Joystick y axis!
64}
65
66//Below is used with extended digital joysticks!
67void setJoystick_other(byte button1, byte button2, byte button3, byte button4, byte button5, byte button6, byte hatleft, byte hatright, byte hatup, byte hatdown, sword analog_x, sword analog_y, sword analog2_x, sword analog2_y) //Input from theuser!
68{
69	//Set the buttons of the joystick in their own buffers(seperated)!
70	JOYSTICK.buttons2[0] = button1?1:0;
71	JOYSTICK.buttons2[1] = button2?1:0;
72	JOYSTICK.buttons2[2] = button3?1:0;
73	JOYSTICK.buttons2[3] = button4?1:0;
74	JOYSTICK.buttons2[4] = button5?1:0; //Unsupported!
75	JOYSTICK.buttons2[5] = button6?1:0; //Unsupported!
76	JOYSTICK.hats[0] = hatleft?1:0;
77	JOYSTICK.hats[1] = hatright?1:0;
78	JOYSTICK.hats[2] = hatup?1:0;
79	JOYSTICK.hats[3] = hatdown?1:0;
80	//Buttons are data streamed instead, so store them seperately!
81	JOYSTICK.Joystick_X[0] = analog_x; //Joystick x axis for compatibility!
82	JOYSTICK.Joystick_Y[0] = analog_y; //Joystick y axis for compatibility!
83	JOYSTICK.Joystick_X[1] = analog2_x; //Joystick x axis!
84	JOYSTICK.Joystick_Y[1] = analog2_y; //Joystick y axis!
85}
86
87void updateJoystick(double timepassed)
88{
89	//Joystick timer!
90	if (JOYSTICK.timeout) //Timing?
91	{
92		if (JOYSTICK.model==0) //Analog model? Use compatibiliy analog emulation!
93		{
94			if (JOYSTICK.enabled[0]) //Joystick A enabled?
95			{
96				if ((JOYSTICK.timeout&1) && (JOYSTICK.enabled[0]&1)) //AX timing?
97				{
98					JOYSTICK.timeoutx[0] -= timepassed; //Add the time to what's left!
99					if (JOYSTICK.timeoutx[0]<=0.0) //Finished timing?
100					{
101						JOYSTICK.timeout &= ~1; //Finished timing, go logic 1(digital 0)!
102					}
103				}
104				if ((JOYSTICK.timeout&2) && (JOYSTICK.enabled[0]==1)) //AY timing?
105				{
106					JOYSTICK.timeouty[0] -= timepassed; //Add the time to what's left!
107					if (JOYSTICK.timeouty[0]<=0.0) //Finished timing?
108					{
109						JOYSTICK.timeout &= ~2; //Finished timing, go logic 1(digital 0)!
110					}
111				}
112			}
113			if (JOYSTICK.enabled[1]) //Joystick B enabled?
114			{
115				if ((JOYSTICK.timeout&4) && (JOYSTICK.enabled[1]&1)) //BX timing?
116				{
117					JOYSTICK.timeoutx[1] -= timepassed; //Add the time to what's left!
118					if (JOYSTICK.timeoutx[1]<=0.0) //Finished timing?
119					{
120						JOYSTICK.timeout &= ~4; //Finished timing, go logic 1(digital 0)!
121					}
122				}
123				if ((JOYSTICK.timeout&8) && (JOYSTICK.enabled[1]==1)) //BY timing?
124				{
125					JOYSTICK.timeouty[1] -= timepassed; //Add the time to what's left!
126					if (JOYSTICK.timeouty[1]<=0.0) //Finished timing?
127					{
128						JOYSTICK.timeout &= ~8; //Finished timing, go logic 1(digital 0)!
129					}
130				}
131			}
132
133			//Add to the digital timing sequence for detecting the activation sequence!
134			JOYSTICK.digitaltiming += timepassed; //Apply timing directly to the digital timing for activation sequence detection!
135		}
136		else //Digital mode? Use packets according to the emulated device!
137		{
138			//Set the current packet, based on the data and timing!
139			switch (JOYSTICK.model) //What model?
140			{
141			default: //Unknown?
142			case MODEL_LOGITECH_WINGMAN_EXTREME_DIGITAL: //Logitech WingMan Extreme Digital?
143				JOYSTICK.digitaltiming += timepassed; //Add the time!
144				if (JOYSTICK.digitaltiming>=JOYSTICK.digitaltiming_step && JOYSTICK.bitmasklow) //To step the counter?
145				{
146					for (;JOYSTICK.digitaltiming>=JOYSTICK.digitaltiming_step;) //Stepping?
147					{
148						JOYSTICK.digitaltiming -= JOYSTICK.digitaltiming_step; //We're stepping!
149						//Give the 1 and 0 bits on the two channels! Buttons 2&3 carry the lower half, Buttons 1&2 carry the upper half!
150						//Lower half!
151						if (JOYSTICK.packet&JOYSTICK.bitmasklow) //Bit is 1?
152						{
153							JOYSTICK.buttons[1] ^= 2; //The upper bit changes state!
154						}
155						else //Bit is 0?
156						{
157							JOYSTICK.buttons[1] ^= 1; //The lower bit changes state!
158						}
159						//Upper half!
160						if (JOYSTICK.packet&JOYSTICK.bitmaskhigh) //Bit is 1?
161						{
162							JOYSTICK.buttons[0] ^= 2; //The upper bit changes state!
163						}
164						else //Bit is 0?
165						{
166							JOYSTICK.buttons[0] ^= 1; //The lower bit changes state!
167						}
168						JOYSTICK.bitmaskhigh >>= 1; //Check the next bit, if any!
169						JOYSTICK.bitmasklow >>= 1; //Check the next bit and update status, if any!
170					}
171				}
172				break;
173			}
174		}
175	}
176}
177
178byte joystick_readIO(word port, byte *result)
179{
180	INLINEREGISTER byte temp;
181	switch (port)
182	{
183		case 0x201: //Read joystick position and status?
184			//bits 8-7 are joystick B buttons 2/1, Bits 6-5 are joystick A buttons 2/1, bit 4-3 are joystick B Y-X timeout timing, bits 1-0 are joystick A Y-X timeout timing.
185			temp = 0xFF; //Init the result!
186			if (JOYSTICK.enabled[1]) //Joystick B enabled?
187			{
188				temp &= 0x33|(((JOYSTICK.buttons[1]<<6)|JOYSTICK.timeout)&0xCC); //Clear joystick B bits when applied!
189			}
190			if (JOYSTICK.enabled[0]) //Joystick A enabled?
191			{
192				temp &= 0xCC|(((JOYSTICK.buttons[0]<<4)|JOYSTICK.timeout)&0x33); //Set joystick A bits when applied!
193			}
194			*result = temp; //Give the result!
195			return 1; //OK!
196		default:
197			break;
198	}
199	return 0; //Not an used port!
200}
201
202byte joystick_writeIO(word port, byte value)
203{
204	#include "headers/packed.h"
205	union
206	{
207		sword axis;
208		word data;
209	} axisconversion;
210	#include "headers/endpacked.h"
211	byte entry;
212	byte sequencepos;
213	switch (port)
214	{
215		case 0x201: //Fire joystick four one-shots?
216			//Set timeoutx and timeouty based on the relative status of Joystick_X and Joystick_Y to fully left/top!
217			//First joystick timeout!
218			if (JOYSTICK.enabled[1]) //Joystick B enabled?
219			{
220				if (JOYSTICK.enabled[1]&1) //X axis used?
221				{
222					JOYSTICK.timeoutx[1] = CALCTIMEOUT((int_32)JOYSTICK.Joystick_X[1]-SHRT_MIN);
223				}
224				if (JOYSTICK.enabled[1]==1) //Y axis used?
225				{
226					JOYSTICK.timeouty[1] = CALCTIMEOUT((int_32)JOYSTICK.Joystick_Y[1]-SHRT_MIN);
227				}
228			}
229			//Second joystick timeout!
230			if (JOYSTICK.enabled[0]) //Joystick A enabled?
231			{
232				if (JOYSTICK.enabled[0]&1) //X axis used?
233				{
234					JOYSTICK.timeoutx[0] = CALCTIMEOUT((int_32)JOYSTICK.Joystick_X[0]-SHRT_MIN);
235				}
236				if (JOYSTICK.enabled[0]==1) //Y axis used?
237				{
238					JOYSTICK.timeouty[0] = CALCTIMEOUT((int_32)JOYSTICK.Joystick_Y[0]-SHRT_MIN);
239				}
240			}
241
242			//Check for activation of the WingMan digital mode!
243			if (JOYSTICK.model==0) //Analog mode?
244			{
245				switch (JOYSTICK.extensionModel) //What extension model?
246				{
247				default: //Unknown?
248					break; //Don't handle model extension!
249				case MODEL_LOGITECH_WINGMAN_EXTREME_DIGITAL: //Logitech WingMan Extreme Digital?
250					if (fifobuffer_freesize(JOYSTICK.digitalmodesequence)==0) //No space left?
251					{
252						readfifobuffer(JOYSTICK.digitalmodesequence,&entry); //Discard an entry!
253					}
254					if ((JOYSTICK.digitaltiming/1000000.0f)>=256.0) //Timeout?
255					{
256						writefifobuffer(JOYSTICK.digitalmodesequence,0xFF); //Simply time out!
257					}
258					else //Within range?
259					{
260						writefifobuffer(JOYSTICK.digitalmodesequence,(byte)(JOYSTICK.digitaltiming/1000000.0f)); //The time since last pulse!
261					}
262					JOYSTICK.digitaltiming = 0.0f; //Reset the timing?
263					fifobuffer_save(JOYSTICK.digitalmodesequence); //Save the position for checking!
264					for (;fifobuffer_freesize(JOYSTICK.digitalmodesequence)<(MAXSEQUENCESIZE-NUMITEMS(WingManDigitalSequence));) //We need the buffer items from the point of the sequence most recently given!
265					{
266						readfifobuffer(JOYSTICK.digitalmodesequence,&entry); //Discard an entry!					
267					}
268					for (sequencepos=0;sequencepos<NUMITEMS(WingManDigitalSequence);) //Check for the sequence!
269					{
270						if (!readfifobuffer(JOYSTICK.digitalmodesequence,&entry)) break; //Not enough entries yet?
271						if (entry!=WingManDigitalSequence[sequencepos]) break; //Only count when the sequence is matched!
272						++sequencepos; //Counted!
273					}
274					fifobuffer_restore(JOYSTICK.digitalmodesequence); //We're finished, undo any reads!
275					if (sequencepos==NUMITEMS(WingManDigitalSequence)) //Sequence pattern matched?
276					{
277						JOYSTICK.model = MODEL_LOGITECH_WINGMAN_EXTREME_DIGITAL; //Enter digital WingMan Digital's digital mode!
278						JOYSTICK.digitaltiming_step = 1000000000.0f/(100000.0f*2.0f); //We're a signal going 1-0 or 0-1 at 100kHz!
279					}
280					break;
281				}
282			}
283			else //Give a packet in the current device format!
284			{
285				switch (JOYSTICK.model) //What model are we?
286				{		
287				default: //Unknown?
288				case 1: //Logitech WingMan Extreme Digital?
289					JOYSTICK.bitmaskhigh = (1ULL<<41); //Reset to the high 21st bit!
290					JOYSTICK.bitmasklow = (1<<20); //Reset to the low 21st bit! We're starting to send a packet, because we're not 0! Once we shift below bit 0, becoming 0, we're finished!
291					JOYSTICK.digitaltiming = 0.0f; //We're starting to send a packet, reset our timing!
292					//Formulate a packet from the current data!
293					/*
294					  Bits     Meaning
295					 0 ..  3 - Hat			(4 bits)
296					 4 ..  9 - Buttons		(6 bits)
297					10 .. 17 - Axis 2 (Twist)	(8 bits)
298					18 .. 25 - Axis 1 (Y)		(8 bits)
299					26 .. 33 - Axis 0 (X)		(8 bits)
300					34 .. 41 - 0x00			(8 bits)
301					*/
302					JOYSTICK.packet = 0; //Initialize the packet!
303					//Now, fill the packet with our current information!
304					//First, hats!
305					JOYSTICK.packet |= JOYSTICK.hats[0]|(JOYSTICK.hats[1]<<1)|(JOYSTICK.hats[2]<<2)|(JOYSTICK.hats[3]<<3);
306					//Then buttons(reversed)!
307					JOYSTICK.packet |= JOYSTICK.buttons2[5]|(JOYSTICK.buttons2[4]<<1)|(JOYSTICK.buttons2[3]<<2)|(JOYSTICK.buttons2[2]<<3)|(JOYSTICK.buttons2[1]<<4)|(JOYSTICK.buttons2[0]<<5);
308					//Axis2(Twist) 8-bits converted!
309					axisconversion.axis = JOYSTICK.Joystick_X[1]; //Twist!
310					JOYSTICK.packet |= (((axisconversion.data>>8)&0xFF)<<10); //Twist converted!
311					//Axis 1(Y) 8-bits converted!
312					axisconversion.axis = JOYSTICK.Joystick_Y[0]; //Y!
313					JOYSTICK.packet |= (((axisconversion.data>>8)&0xFF)<<18); //Twist converted!
314					//Axis 0(X) 8-bits converted!
315					axisconversion.axis = JOYSTICK.Joystick_X[0]; //Y!
316					JOYSTICK.packet |= (((axisconversion.data>>8)&0xFF)<<26); //Twist converted!
317					//The upper bits are 0x00!
318					break;
319				}
320			}
321			JOYSTICK.timeout = 0xF; //Start the timeout on all channels, regardless if they're enabled. Multivibrator output goes to logic 0.
322			return 1; //OK!
323		default:
324			break;
325	}
326	return 0; //Not an used port!
327}
328
329void joystickInit()
330{
331	register_PORTIN(&joystick_readIO); //Register our handler!
332	register_PORTOUT(&joystick_writeIO); //Register our handler!
333	JOYSTICK.buttons[0] = JOYSTICK.buttons[1] = 3; //Not pressed!
334	JOYSTICK.timeoutx[0] = JOYSTICK.timeouty[0] = JOYSTICK.timeoutx[1] = JOYSTICK.timeouty[1] = 0.0; //Init timeout to nothing!
335	JOYSTICK.timeout = 0x0; //Default: all lines timed out!
336	JOYSTICK.model = 0; //Default: analog model(compatibility)!
337	JOYSTICK.digitaltiming = 0.0f; //Reset our digital detection(during analog mode)/step(during digital mode) timing!
338	JOYSTICK.digitalmodesequence = allocfifobuffer(MAXSEQUENCESIZE,0); //We use a simple buffer with 10 8-bit entries, unlocked!
339	JOYSTICK.lasttiming = 0.0f; //Last write digital timing delay!
340	JOYSTICK.extensionModel = 0; //Default: no extension specified!
341}
342
343void joystickDone()
344{
345	free_fifobuffer(&JOYSTICK.digitalmodesequence); //Release our buffer, we're finished with it!
346}