Justin S / Mbed 2 deprecated N64_Output_XPAD

v1 Stable

Dependencies:   F401RE-USBHost USBHostXpad mbed

main.cpp@12:0cc5d9260495, 2017-04-15 (annotated)

Committer:
Ownasaurus
Date:
Sat Apr 15 02:19:42 2017 +0000
Revision:
12:0cc5d9260495
Parent:
10:02dbdace7cfb
Child:
13:d7c1aae2b48f
changed analog sensitivity/deadzone code to be consistent with nrage's algorithm

Who changed what in which revision?

UserRevisionLine numberNew contents of line
Ownasaurus 0:eb2258e8c4b5 1 #include "mbed.h"
Ownasaurus 2:c20d8438f206 2 #include "USBHostXpad.h"
Ownasaurus 3:52b2a7514406 3 #include "stm32f4xx_flash.h"
Ownasaurus 2:c20d8438f206 4
Ownasaurus 2:c20d8438f206 5 DigitalOut myled(LED1);
Ownasaurus 2:c20d8438f206 6 Serial pc(USBTX, USBRX); // tx, rx
Ownasaurus 2:c20d8438f206 7 DigitalInOut data(PA_8);
Ownasaurus 5:32c8b316582a 8 DigitalIn button(PC_13); // eventually code to set controls
Ownasaurus 2:c20d8438f206 9
Ownasaurus 2:c20d8438f206 10 /**
Ownasaurus 2:c20d8438f206 11 @namespace AXYB
Ownasaurus 2:c20d8438f206 12 @brief Integer for storing the hex of the A X Y B buttons
Ownasaurus 2:c20d8438f206 13 @brief XPad returns a 4 digit hex for all buttons- AXYB buttons are stored in first value
Ownasaurus 2:c20d8438f206 14 @param A - given as a 1
Ownasaurus 2:c20d8438f206 15 @param B - given as a 2
Ownasaurus 2:c20d8438f206 16 @param X - given as a 4
Ownasaurus 2:c20d8438f206 17 @param Y - given as a 8
Ownasaurus 2:c20d8438f206 18 */
Ownasaurus 2:c20d8438f206 19 uint8_t AXYB=0x0;
Ownasaurus 2:c20d8438f206 20 /**
Ownasaurus 2:c20d8438f206 21 @namespace XLBRB
Ownasaurus 2:c20d8438f206 22 @brief Integer for storing the hex of the LB,RB and center X buttons
Ownasaurus 3:52b2a7514406 23 @brief XPad returns a 4 digit hex for all buttons- XLBRB buttons are stored in second value
Ownasaurus 2:c20d8438f206 24 @param LB - given as a 1
Ownasaurus 2:c20d8438f206 25 @param R - given as a 2
Ownasaurus 2:c20d8438f206 26 @param X - given as a 4
Ownasaurus 2:c20d8438f206 27 */
Ownasaurus 2:c20d8438f206 28 uint8_t XLBRB=0x0;
Ownasaurus 2:c20d8438f206 29
Ownasaurus 2:c20d8438f206 30 /**
Ownasaurus 2:c20d8438f206 31 @namespace bkStrtLCRC
Ownasaurus 2:c20d8438f206 32 @brief Integer for storing the hex of the Left analog button,Right analog button,back and start buttons
Ownasaurus 3:52b2a7514406 33 @brief XPad returns a 4 digit hex for all buttons- bkStrtLCRC buttons are stored in third value
Ownasaurus 2:c20d8438f206 34 @param start - given as a 1
Ownasaurus 2:c20d8438f206 35 @param back - given as a 2
Ownasaurus 2:c20d8438f206 36 @param LC - given as a 4
Ownasaurus 2:c20d8438f206 37 @param RC - given as a 8
Ownasaurus 2:c20d8438f206 38 */
Ownasaurus 2:c20d8438f206 39 uint8_t bkStrtLCRC=0x0;
Ownasaurus 2:c20d8438f206 40 /**
Ownasaurus 2:c20d8438f206 41 @namespace DPad
Ownasaurus 2:c20d8438f206 42 @brief Integer for storing the hex of the Directional buttons
Ownasaurus 3:52b2a7514406 43 @brief XPad returns a 4 digit hex for all buttons- DPad buttons are stored in fourth value
Ownasaurus 2:c20d8438f206 44 @param Up - given as a 1
Ownasaurus 2:c20d8438f206 45 @param Down - given as a 2
Ownasaurus 2:c20d8438f206 46 @param Left - given as a 4
Ownasaurus 2:c20d8438f206 47 @param Right - given as a 8
Ownasaurus 2:c20d8438f206 48 */
Ownasaurus 2:c20d8438f206 49 uint8_t DPad=0x0;
Ownasaurus 2:c20d8438f206 50 /**
Ownasaurus 2:c20d8438f206 51 @namespace LSY
Ownasaurus 2:c20d8438f206 52 @brief float for storing the value of the Left Analogue Stick's Y axis
Ownasaurus 2:c20d8438f206 53 @brief XPad returns a value between -32768(down) and 32767(up)
Ownasaurus 2:c20d8438f206 54 @there is a deadzone between around -4000 and 4000 where the value returned is not consistent when in the fixed position(assummed 0,0 point)
Ownasaurus 2:c20d8438f206 55 */
Ownasaurus 2:c20d8438f206 56 char LSY=0x0;
Ownasaurus 2:c20d8438f206 57 /**
Ownasaurus 2:c20d8438f206 58 @namespace LSX
Ownasaurus 2:c20d8438f206 59 @brief float for storing the value of the Left Analogue Stick's X axis
Ownasaurus 2:c20d8438f206 60 @brief XPad returns a value between -32768(left) and 32767(right)
Ownasaurus 2:c20d8438f206 61 @there is a deadzone between around -4000 and 4000 where the value returned is not consistent when in the fixed position(assummed 0,0 point)
Ownasaurus 2:c20d8438f206 62 */
Ownasaurus 2:c20d8438f206 63 char LSX=0x0;
Ownasaurus 2:c20d8438f206 64 /**
Ownasaurus 2:c20d8438f206 65 @namespace RSY
Ownasaurus 2:c20d8438f206 66 @brief float for storing the value of the Right Analogue Stick's Y axis
Ownasaurus 2:c20d8438f206 67 @brief XPad returns a value between -32768() and 32767(up)
Ownasaurus 2:c20d8438f206 68 @there is a deadzone between around -4000 and 4000 where the value returned is not consistent when in the fixed position(assummed 0,0 point)
Ownasaurus 2:c20d8438f206 69 */
Ownasaurus 2:c20d8438f206 70 float RSY=0x0;
Ownasaurus 2:c20d8438f206 71 /**
Ownasaurus 2:c20d8438f206 72 @namespace RSX
Ownasaurus 2:c20d8438f206 73 @brief float for storing the value of the Right Analogue Stick's X axis
Ownasaurus 2:c20d8438f206 74 @brief XPad returns a value between -32768(left) and 32767(right)
Ownasaurus 2:c20d8438f206 75 @there is a deadzone between around -4000 and 4000 where the value returned is not consistent when in the fixed position(assummed 0,0 point)
Ownasaurus 2:c20d8438f206 76 */
Ownasaurus 2:c20d8438f206 77 float RSX=0x0;
Ownasaurus 2:c20d8438f206 78 /**
Ownasaurus 2:c20d8438f206 79 @namespace sN
Ownasaurus 2:c20d8438f206 80 @brief float for storing the stick Normalising value
Ownasaurus 2:c20d8438f206 81 @brief makes the range of the sticks -80 to 80
Ownasaurus 2:c20d8438f206 82 */
Ownasaurus 2:c20d8438f206 83 const float sN=0.00244140625;//(80/32768)
Ownasaurus 2:c20d8438f206 84 /**
Ownasaurus 2:c20d8438f206 85 @namespace Lt
Ownasaurus 2:c20d8438f206 86 @brief float for storing the value of the Left trigger
Ownasaurus 2:c20d8438f206 87 @brief XPad returns a value between 0(not pressed) and 255(fully pressed)
Ownasaurus 2:c20d8438f206 88 @
Ownasaurus 2:c20d8438f206 89 */
Ownasaurus 2:c20d8438f206 90 float Lt=0x0;
Ownasaurus 2:c20d8438f206 91 /**
Ownasaurus 2:c20d8438f206 92 @namespace Rt
Ownasaurus 2:c20d8438f206 93 @brief float for storing the value of the Left trigger
Ownasaurus 2:c20d8438f206 94 @brief XPad returns a value between 0(not pressed) and 255(fully pressed)
Ownasaurus 2:c20d8438f206 95 @
Ownasaurus 2:c20d8438f206 96 */
Ownasaurus 2:c20d8438f206 97 float Rt=0x0;
Ownasaurus 2:c20d8438f206 98 /**
Ownasaurus 2:c20d8438f206 99 @namespace tN
Ownasaurus 2:c20d8438f206 100 @brief float for storing the trigger Normalising value
Ownasaurus 2:c20d8438f206 101 @brief makes the range of the triggers 0 to 10
Ownasaurus 2:c20d8438f206 102 */
Ownasaurus 2:c20d8438f206 103 const float tN=0.03921568627;//(10/255)
Ownasaurus 6:21365f733399 104 const int dead_zone = 20;
Ownasaurus 12:0cc5d9260495 105 const int sensitivity = 100;
Ownasaurus 6:21365f733399 106 const int TRIGGER_THRESHOLD = 5;
Ownasaurus 2:c20d8438f206 107
Ownasaurus 2:c20d8438f206 108 char reverse(char b)
Ownasaurus 2:c20d8438f206 109 {
Ownasaurus 2:c20d8438f206 110 b = (b & 0xF0) >> 4 | (b & 0x0F) << 4;
Ownasaurus 2:c20d8438f206 111 b = (b & 0xCC) >> 2 | (b & 0x33) << 2;
Ownasaurus 2:c20d8438f206 112 b = (b & 0xAA) >> 1 | (b & 0x55) << 1;
Ownasaurus 2:c20d8438f206 113 return b;
Ownasaurus 2:c20d8438f206 114 }
Ownasaurus 0:eb2258e8c4b5 115
Ownasaurus 6:21365f733399 116 enum STATE {NORMAL=0, DPAD_UP, DPAD_DOWN, DPAD_LEFT, DPAD_RIGHT, BUTTON_START, BUTTON_B, BUTTON_A, C_UP, C_DOWN, C_LEFT, C_RIGHT, BUTTON_L, BUTTON_R, BUTTON_Z};
Ownasaurus 6:21365f733399 117 enum XPAD_BUTTON {XPAD_DUP, XPAD_DDOWN, XPAD_DLEFT, XPAD_DRIGHT, XPAD_X, XPAD_Y, XPAD_A, XPAD_B, XPAD_LB, XPAD_RB, XPAD_LT, XPAD_RT, XPAD_BACK, XPAD_START, XPAD_LAB, XPAD_RAB};
Ownasaurus 6:21365f733399 118
Ownasaurus 6:21365f733399 119 uint8_t state = NORMAL;
Ownasaurus 6:21365f733399 120 bool XpadButtonPressed = false;
Ownasaurus 6:21365f733399 121
Ownasaurus 6:21365f733399 122 const uint64_t A_MASK = 0x00001000,
Ownasaurus 6:21365f733399 123 B_MASK = 0x00002000,
Ownasaurus 6:21365f733399 124 X_MASK = 0x00004000,
Ownasaurus 6:21365f733399 125 Y_MASK = 0x00008000,
Ownasaurus 6:21365f733399 126 LB_MASK = 0x00000100,
Ownasaurus 6:21365f733399 127 RB_MASK = 0x00000200,
Ownasaurus 6:21365f733399 128 START_MASK = 0x00000010,
Ownasaurus 6:21365f733399 129 BACK_MASK = 0x00000020,
Ownasaurus 6:21365f733399 130 LAB_MASK = 0x00000040,
Ownasaurus 6:21365f733399 131 RAB_MASK = 0x00000080,
Ownasaurus 6:21365f733399 132 DUP_MASK = 0x00000001,
Ownasaurus 6:21365f733399 133 DDOWN_MASK = 0x00000002,
Ownasaurus 6:21365f733399 134 DLEFT_MASK = 0x00000004,
Ownasaurus 6:21365f733399 135 DRIGHT_MASK = 0x00000008,
Ownasaurus 6:21365f733399 136 // the next two masks are special extensions to support triggers
Ownasaurus 6:21365f733399 137 LT_MASK = 0x00010000,
Ownasaurus 6:21365f733399 138 RT_MASK = 0x00020000;
Ownasaurus 6:21365f733399 139
Ownasaurus 0:eb2258e8c4b5 140 extern "C" void my_wait_us_asm (int n);
Ownasaurus 6:21365f733399 141 void LoadControls();
Ownasaurus 6:21365f733399 142 void SaveControls();
Ownasaurus 0:eb2258e8c4b5 143
Ownasaurus 5:32c8b316582a 144 struct __attribute__((packed)) N64ControllerData // all bits are in the correct order... except for the analog
Ownasaurus 1:3c21da72660d 145 {
Ownasaurus 1:3c21da72660d 146 unsigned int a : 1; // 1 bit wide
Ownasaurus 1:3c21da72660d 147 unsigned int b : 1;
Ownasaurus 1:3c21da72660d 148 unsigned int z : 1;
Ownasaurus 1:3c21da72660d 149 unsigned int start : 1;
Ownasaurus 1:3c21da72660d 150 unsigned int up : 1;
Ownasaurus 1:3c21da72660d 151 unsigned int down : 1;
Ownasaurus 1:3c21da72660d 152 unsigned int left : 1;
Ownasaurus 1:3c21da72660d 153 unsigned int right : 1;
Ownasaurus 1:3c21da72660d 154
Ownasaurus 1:3c21da72660d 155 unsigned int dummy1 : 1;
Ownasaurus 1:3c21da72660d 156 unsigned int dummy2 : 1;
Ownasaurus 6:21365f733399 157 unsigned int l : 1;
Ownasaurus 1:3c21da72660d 158 unsigned int r : 1;
Ownasaurus 1:3c21da72660d 159 unsigned int c_up : 1;
Ownasaurus 1:3c21da72660d 160 unsigned int c_down : 1;
Ownasaurus 1:3c21da72660d 161 unsigned int c_left : 1;
Ownasaurus 1:3c21da72660d 162 unsigned int c_right : 1;
Ownasaurus 1:3c21da72660d 163
Ownasaurus 1:3c21da72660d 164 char x_axis;
Ownasaurus 1:3c21da72660d 165
Ownasaurus 1:3c21da72660d 166 char y_axis;
Ownasaurus 1:3c21da72660d 167
Ownasaurus 1:3c21da72660d 168 } n64_data;
Ownasaurus 1:3c21da72660d 169
Ownasaurus 6:21365f733399 170 struct __attribute__((packed)) XpadControls
Ownasaurus 6:21365f733399 171 {
Ownasaurus 6:21365f733399 172 uint64_t a;
Ownasaurus 6:21365f733399 173 uint64_t b;
Ownasaurus 6:21365f733399 174 uint64_t z;
Ownasaurus 6:21365f733399 175 uint64_t start;
Ownasaurus 6:21365f733399 176 uint64_t up;
Ownasaurus 6:21365f733399 177 uint64_t down;
Ownasaurus 6:21365f733399 178 uint64_t left;
Ownasaurus 6:21365f733399 179 uint64_t right;
Ownasaurus 6:21365f733399 180 uint64_t l;
Ownasaurus 6:21365f733399 181 uint64_t r;
Ownasaurus 6:21365f733399 182 uint64_t c_up;
Ownasaurus 6:21365f733399 183 uint64_t c_down;
Ownasaurus 6:21365f733399 184 uint64_t c_left;
Ownasaurus 6:21365f733399 185 uint64_t c_right;
Ownasaurus 6:21365f733399 186
Ownasaurus 6:21365f733399 187 XpadControls()
Ownasaurus 6:21365f733399 188 {
Ownasaurus 6:21365f733399 189 LoadControls();
Ownasaurus 6:21365f733399 190 }
Ownasaurus 6:21365f733399 191
Ownasaurus 6:21365f733399 192 void PrintControls()
Ownasaurus 6:21365f733399 193 {
Ownasaurus 6:21365f733399 194 pc.printf("The mask for a is: 0x%X\r\n",a);
Ownasaurus 6:21365f733399 195 pc.printf("The mask for start is: 0x%X\r\n",start);
Ownasaurus 6:21365f733399 196 }
Ownasaurus 6:21365f733399 197 } xpc;
Ownasaurus 6:21365f733399 198
Ownasaurus 6:21365f733399 199 const int SAVE_ADDR = 0x0800C000; // sector 3
Ownasaurus 6:21365f733399 200 XpadControls* saveData = (XpadControls*)SAVE_ADDR;
Ownasaurus 6:21365f733399 201
Ownasaurus 6:21365f733399 202 // linear search, find first button pressed
Ownasaurus 6:21365f733399 203 // if the user pressed 2 buttons, its the user's fault
Ownasaurus 6:21365f733399 204 uint64_t DetectButton()
Ownasaurus 6:21365f733399 205 {
Ownasaurus 6:21365f733399 206 if(AXYB != 0)
Ownasaurus 6:21365f733399 207 {
Ownasaurus 6:21365f733399 208 if(AXYB & 0x01) // a
Ownasaurus 6:21365f733399 209 {
Ownasaurus 6:21365f733399 210 return A_MASK;
Ownasaurus 6:21365f733399 211 }
Ownasaurus 6:21365f733399 212 else if((AXYB >> 1) & 0x01) // b
Ownasaurus 6:21365f733399 213 {
Ownasaurus 6:21365f733399 214 return B_MASK;
Ownasaurus 6:21365f733399 215 }
Ownasaurus 6:21365f733399 216 else if((AXYB >> 2) & 0x01) // x
Ownasaurus 6:21365f733399 217 {
Ownasaurus 6:21365f733399 218 return X_MASK;
Ownasaurus 6:21365f733399 219 }
Ownasaurus 6:21365f733399 220 else if((AXYB >> 3) & 0x01) // y
Ownasaurus 6:21365f733399 221 {
Ownasaurus 6:21365f733399 222 return Y_MASK;
Ownasaurus 6:21365f733399 223 }
Ownasaurus 6:21365f733399 224 }
Ownasaurus 6:21365f733399 225 else if(XLBRB != 0)
Ownasaurus 6:21365f733399 226 {
Ownasaurus 6:21365f733399 227 if((XLBRB >> 1) & 0x01) // right bumper
Ownasaurus 6:21365f733399 228 {
Ownasaurus 6:21365f733399 229 return RB_MASK;
Ownasaurus 6:21365f733399 230 }
Ownasaurus 6:21365f733399 231 else if(XLBRB & 0x01) // left bumper
Ownasaurus 6:21365f733399 232 {
Ownasaurus 6:21365f733399 233 return LB_MASK;
Ownasaurus 6:21365f733399 234 }
Ownasaurus 6:21365f733399 235 // the Xbox ("X") button is ignored in this firmware
Ownasaurus 6:21365f733399 236 }
Ownasaurus 6:21365f733399 237 else if(bkStrtLCRC != 0)
Ownasaurus 6:21365f733399 238 {
Ownasaurus 6:21365f733399 239 if(bkStrtLCRC & 0x01) // start
Ownasaurus 6:21365f733399 240 {
Ownasaurus 6:21365f733399 241 return START_MASK;
Ownasaurus 6:21365f733399 242 }
Ownasaurus 6:21365f733399 243 else if(bkStrtLCRC & 0x02) // back
Ownasaurus 6:21365f733399 244 {
Ownasaurus 6:21365f733399 245 return BACK_MASK;
Ownasaurus 6:21365f733399 246 }
Ownasaurus 6:21365f733399 247 else if(bkStrtLCRC & 0x04) // L analog button
Ownasaurus 6:21365f733399 248 {
Ownasaurus 6:21365f733399 249 return LAB_MASK;
Ownasaurus 6:21365f733399 250 }
Ownasaurus 6:21365f733399 251 else if(bkStrtLCRC & 0x08) // R analog button
Ownasaurus 6:21365f733399 252 {
Ownasaurus 6:21365f733399 253 return RAB_MASK;
Ownasaurus 6:21365f733399 254 }
Ownasaurus 6:21365f733399 255 }
Ownasaurus 6:21365f733399 256 else if(DPad != 0)
Ownasaurus 6:21365f733399 257 {
Ownasaurus 6:21365f733399 258 if(DPad & 0x01) // DPad Up
Ownasaurus 6:21365f733399 259 {
Ownasaurus 6:21365f733399 260 return DUP_MASK;
Ownasaurus 6:21365f733399 261 }
Ownasaurus 6:21365f733399 262 else if(DPad & 0x02) // DPad Down
Ownasaurus 6:21365f733399 263 {
Ownasaurus 6:21365f733399 264 return DDOWN_MASK;
Ownasaurus 6:21365f733399 265 }
Ownasaurus 6:21365f733399 266 else if(DPad & 0x04) // DPad Left
Ownasaurus 6:21365f733399 267 {
Ownasaurus 6:21365f733399 268 return DLEFT_MASK;
Ownasaurus 6:21365f733399 269 }
Ownasaurus 6:21365f733399 270 else if(DPad & 0x08) // DPad Right
Ownasaurus 6:21365f733399 271 {
Ownasaurus 6:21365f733399 272 return DRIGHT_MASK;
Ownasaurus 6:21365f733399 273 }
Ownasaurus 6:21365f733399 274 }
Ownasaurus 6:21365f733399 275 else if(Lt > TRIGGER_THRESHOLD)
Ownasaurus 6:21365f733399 276 {
Ownasaurus 6:21365f733399 277 return LT_MASK;
Ownasaurus 6:21365f733399 278 }
Ownasaurus 6:21365f733399 279 else if(Rt > TRIGGER_THRESHOLD)
Ownasaurus 6:21365f733399 280 {
Ownasaurus 6:21365f733399 281 return RT_MASK;
Ownasaurus 6:21365f733399 282 }
Ownasaurus 6:21365f733399 283
Ownasaurus 6:21365f733399 284 return 0; // no button was pressed
Ownasaurus 6:21365f733399 285 }
Ownasaurus 6:21365f733399 286
Ownasaurus 6:21365f733399 287 void ChangeButtonMapping(uint64_t bt)
Ownasaurus 6:21365f733399 288 {
Ownasaurus 6:21365f733399 289 // analog settings must be hardcoded, cannot change on the fly
Ownasaurus 6:21365f733399 290
Ownasaurus 6:21365f733399 291 if(state == DPAD_UP) // state = 1 --> dpad up
Ownasaurus 6:21365f733399 292 {
Ownasaurus 6:21365f733399 293 xpc.up = bt;
Ownasaurus 6:21365f733399 294 }
Ownasaurus 6:21365f733399 295 else if(state == DPAD_DOWN) // state = 2 --> dpad down
Ownasaurus 6:21365f733399 296 {
Ownasaurus 6:21365f733399 297 xpc.down = bt;
Ownasaurus 6:21365f733399 298 }
Ownasaurus 6:21365f733399 299 else if(state == DPAD_LEFT) // state = 3 --> dpad left
Ownasaurus 6:21365f733399 300 {
Ownasaurus 6:21365f733399 301 xpc.left = bt;
Ownasaurus 6:21365f733399 302 }
Ownasaurus 6:21365f733399 303 else if(state == DPAD_RIGHT) // state = 4 --> dpad right
Ownasaurus 6:21365f733399 304 {
Ownasaurus 6:21365f733399 305 xpc.right = bt;
Ownasaurus 6:21365f733399 306 }
Ownasaurus 6:21365f733399 307 else if(state == BUTTON_START) // state = 5 --> start
Ownasaurus 6:21365f733399 308 {
Ownasaurus 6:21365f733399 309 xpc.start = bt;
Ownasaurus 6:21365f733399 310 }
Ownasaurus 6:21365f733399 311 else if(state == BUTTON_B) // state = 6 --> B
Ownasaurus 6:21365f733399 312 {
Ownasaurus 6:21365f733399 313 xpc.b = bt;
Ownasaurus 6:21365f733399 314 }
Ownasaurus 6:21365f733399 315 else if(state == BUTTON_A) // state = 7 --> A
Ownasaurus 6:21365f733399 316 {
Ownasaurus 6:21365f733399 317 xpc.a = bt;
Ownasaurus 6:21365f733399 318 }
Ownasaurus 6:21365f733399 319 else if(state == C_UP) // state = 8 --> c up
Ownasaurus 6:21365f733399 320 {
Ownasaurus 6:21365f733399 321 xpc.c_up = bt;
Ownasaurus 6:21365f733399 322 }
Ownasaurus 6:21365f733399 323 else if(state == C_DOWN) // state = 9 --> c down
Ownasaurus 6:21365f733399 324 {
Ownasaurus 6:21365f733399 325 xpc.c_down = bt;
Ownasaurus 6:21365f733399 326 }
Ownasaurus 6:21365f733399 327 else if(state == C_LEFT) // state = 10 --> c left
Ownasaurus 6:21365f733399 328 {
Ownasaurus 6:21365f733399 329 xpc.c_left = bt;
Ownasaurus 6:21365f733399 330 }
Ownasaurus 6:21365f733399 331 else if(state == C_RIGHT) // state = 11 --> c right
Ownasaurus 6:21365f733399 332 {
Ownasaurus 6:21365f733399 333 xpc.c_right = bt;
Ownasaurus 6:21365f733399 334 }
Ownasaurus 6:21365f733399 335 else if(state == BUTTON_L) // state = 12 --> L
Ownasaurus 6:21365f733399 336 {
Ownasaurus 6:21365f733399 337 xpc.l = bt;
Ownasaurus 6:21365f733399 338 }
Ownasaurus 6:21365f733399 339 else if(state == BUTTON_R) // state = 13 --> R
Ownasaurus 6:21365f733399 340 {
Ownasaurus 6:21365f733399 341 xpc.r = bt;
Ownasaurus 6:21365f733399 342 }
Ownasaurus 6:21365f733399 343 else if(state == BUTTON_Z) // state = 14 --> Z
Ownasaurus 6:21365f733399 344 {
Ownasaurus 6:21365f733399 345 xpc.z = bt;
Ownasaurus 6:21365f733399 346 }
Ownasaurus 6:21365f733399 347 }
Ownasaurus 6:21365f733399 348
Ownasaurus 6:21365f733399 349 void SaveControls()
Ownasaurus 6:21365f733399 350 {
Ownasaurus 6:21365f733399 351 FLASH_Unlock(); //unlock flash writing
Ownasaurus 6:21365f733399 352 FLASH_ClearFlag(FLASH_FLAG_EOP | FLASH_FLAG_OPERR | FLASH_FLAG_WRPERR |
Ownasaurus 6:21365f733399 353 FLASH_FLAG_PGAERR | FLASH_FLAG_PGPERR|FLASH_FLAG_PGSERR);
Ownasaurus 6:21365f733399 354 FLASH_EraseSector(FLASH_Sector_3,VoltageRange_3); // 0x0800C000 - 0x0800FFFF
Ownasaurus 6:21365f733399 355
Ownasaurus 6:21365f733399 356 uint32_t* data = (uint32_t*)&xpc;
Ownasaurus 6:21365f733399 357
Ownasaurus 6:21365f733399 358 // Total size is 112 bytes
Ownasaurus 6:21365f733399 359 // Each word is 4 bytes, so the total size is 28 words
Ownasaurus 6:21365f733399 360 // Note: ProgramDoubleWord requires a higher voltage, so we must do one word at a time
Ownasaurus 6:21365f733399 361 for(int ct = 0;ct < 28;ct++)
Ownasaurus 6:21365f733399 362 {
Ownasaurus 6:21365f733399 363 FLASH_ProgramWord(SAVE_ADDR+(ct*4),*data); //each SAVE_ADDR+4 is 4 bytes because it is a memory address
Ownasaurus 6:21365f733399 364 data++; // each data+1 is 4 bytes because it is a 32 bit data type
Ownasaurus 6:21365f733399 365 }
Ownasaurus 6:21365f733399 366
Ownasaurus 6:21365f733399 367 FLASH_Lock(); // lock it back up
Ownasaurus 6:21365f733399 368 }
Ownasaurus 6:21365f733399 369
Ownasaurus 6:21365f733399 370 void LoadControls()
Ownasaurus 6:21365f733399 371 {
Ownasaurus 6:21365f733399 372 memcpy(&xpc,saveData,sizeof(XpadControls));
Ownasaurus 6:21365f733399 373 pc.printf("Controls have been loaded!\r\n");
Ownasaurus 6:21365f733399 374 }
Ownasaurus 6:21365f733399 375
Ownasaurus 6:21365f733399 376 void AdvanceState()
Ownasaurus 6:21365f733399 377 {
Ownasaurus 6:21365f733399 378 state++;
Ownasaurus 6:21365f733399 379 if(state >= 15) // we're done mapping the controls
Ownasaurus 6:21365f733399 380 {
Ownasaurus 6:21365f733399 381 SaveControls(); // write directly to flash
Ownasaurus 6:21365f733399 382 state = NORMAL; // back to normal controller operation
Ownasaurus 6:21365f733399 383 }
Ownasaurus 6:21365f733399 384 }
Ownasaurus 6:21365f733399 385
Ownasaurus 3:52b2a7514406 386 void onXpadEvent (int buttons, int stick_lx, int stick_ly, int stick_rx, int stick_ry, int trigger_l, int trigger_r)
Ownasaurus 2:c20d8438f206 387 {
Ownasaurus 9:b64b08b130ed 388 //pc.printf("A button was pressed!\r\n",state); // DEBUG
Ownasaurus 3:52b2a7514406 389 AXYB=buttons>>12;
Ownasaurus 3:52b2a7514406 390 XLBRB=(buttons&0x0f00)>>8;
Ownasaurus 3:52b2a7514406 391 bkStrtLCRC=(buttons&0x00f0)>>4;
Ownasaurus 3:52b2a7514406 392 DPad=buttons&0x000f;
Ownasaurus 2:c20d8438f206 393
Ownasaurus 5:32c8b316582a 394 //pc.printf("AXYB: %u, XLBRB, %u, bkStrtLCRC %u, DPad, %u\r\n",AXYB,XLBRB,bkStrtLCRC,DPad);
Ownasaurus 5:32c8b316582a 395
Ownasaurus 5:32c8b316582a 396 // normalize the analog stick values to be 80 max
Ownasaurus 6:21365f733399 397 //LSY=(char)((int)(stick_ly*sN));
Ownasaurus 6:21365f733399 398 //LSX=(char)((int)(stick_lx*sN));
Ownasaurus 12:0cc5d9260495 399 //RSY=stick_ry*sN;
Ownasaurus 12:0cc5d9260495 400 //RSX=stick_rx*sN;
Ownasaurus 2:c20d8438f206 401
Ownasaurus 5:32c8b316582a 402 // normalize the trigger values to be 10 max
Ownasaurus 3:52b2a7514406 403 Lt=trigger_l*tN;
Ownasaurus 3:52b2a7514406 404 Rt=trigger_r*tN;
Ownasaurus 2:c20d8438f206 405
Ownasaurus 6:21365f733399 406 if(state == 0)
Ownasaurus 3:52b2a7514406 407 {
Ownasaurus 6:21365f733399 408 memset(&n64_data,0,4); // clear controller state
Ownasaurus 6:21365f733399 409
Ownasaurus 6:21365f733399 410 uint64_t buttons_and_triggers = buttons;
Ownasaurus 6:21365f733399 411
Ownasaurus 6:21365f733399 412 if(Lt > TRIGGER_THRESHOLD)
Ownasaurus 6:21365f733399 413 {
Ownasaurus 6:21365f733399 414 buttons_and_triggers |= LT_MASK;
Ownasaurus 6:21365f733399 415 }
Ownasaurus 6:21365f733399 416 if(Rt > TRIGGER_THRESHOLD)
Ownasaurus 6:21365f733399 417 {
Ownasaurus 6:21365f733399 418 buttons_and_triggers |= RT_MASK;
Ownasaurus 6:21365f733399 419 }
Ownasaurus 6:21365f733399 420
Ownasaurus 6:21365f733399 421 if(buttons_and_triggers & xpc.up)
Ownasaurus 6:21365f733399 422 {
Ownasaurus 6:21365f733399 423 n64_data.up = 1;
Ownasaurus 6:21365f733399 424 }
Ownasaurus 6:21365f733399 425 if(buttons_and_triggers & xpc.down)
Ownasaurus 6:21365f733399 426 {
Ownasaurus 6:21365f733399 427 n64_data.down = 1;
Ownasaurus 6:21365f733399 428 }
Ownasaurus 6:21365f733399 429 if(buttons_and_triggers & xpc.left)
Ownasaurus 6:21365f733399 430 {
Ownasaurus 6:21365f733399 431 n64_data.left = 1;
Ownasaurus 6:21365f733399 432 }
Ownasaurus 6:21365f733399 433 if(buttons_and_triggers & xpc.right)
Ownasaurus 6:21365f733399 434 {
Ownasaurus 6:21365f733399 435 n64_data.right = 1;
Ownasaurus 6:21365f733399 436 }
Ownasaurus 6:21365f733399 437 if(buttons_and_triggers & xpc.c_up)
Ownasaurus 6:21365f733399 438 {
Ownasaurus 6:21365f733399 439 n64_data.c_up = 1;
Ownasaurus 6:21365f733399 440 }
Ownasaurus 6:21365f733399 441 if(buttons_and_triggers & xpc.c_down)
Ownasaurus 6:21365f733399 442 {
Ownasaurus 6:21365f733399 443 n64_data.c_down = 1;
Ownasaurus 6:21365f733399 444 }
Ownasaurus 6:21365f733399 445 if(buttons_and_triggers & xpc.c_left)
Ownasaurus 6:21365f733399 446 {
Ownasaurus 6:21365f733399 447 n64_data.c_left = 1;
Ownasaurus 6:21365f733399 448 }
Ownasaurus 6:21365f733399 449 if(buttons_and_triggers & xpc.c_right)
Ownasaurus 6:21365f733399 450 {
Ownasaurus 6:21365f733399 451 n64_data.c_right = 1;
Ownasaurus 6:21365f733399 452 }
Ownasaurus 6:21365f733399 453 if(buttons_and_triggers & xpc.l)
Ownasaurus 6:21365f733399 454 {
Ownasaurus 6:21365f733399 455 n64_data.l = 1;
Ownasaurus 6:21365f733399 456 }
Ownasaurus 6:21365f733399 457 if(buttons_and_triggers & xpc.r)
Ownasaurus 6:21365f733399 458 {
Ownasaurus 6:21365f733399 459 n64_data.r = 1;
Ownasaurus 6:21365f733399 460 }
Ownasaurus 6:21365f733399 461 if(buttons_and_triggers & xpc.z)
Ownasaurus 6:21365f733399 462 {
Ownasaurus 6:21365f733399 463 n64_data.z = 1;
Ownasaurus 6:21365f733399 464 }
Ownasaurus 6:21365f733399 465 if(buttons_and_triggers & xpc.a)
Ownasaurus 6:21365f733399 466 {
Ownasaurus 6:21365f733399 467 n64_data.a = 1;
Ownasaurus 6:21365f733399 468 }
Ownasaurus 6:21365f733399 469 if(buttons_and_triggers & xpc.b)
Ownasaurus 6:21365f733399 470 {
Ownasaurus 6:21365f733399 471 n64_data.b = 1;
Ownasaurus 6:21365f733399 472 }
Ownasaurus 6:21365f733399 473 if(buttons_and_triggers & xpc.start)
Ownasaurus 6:21365f733399 474 {
Ownasaurus 6:21365f733399 475 n64_data.start = 1;
Ownasaurus 6:21365f733399 476 }
Ownasaurus 6:21365f733399 477
Ownasaurus 6:21365f733399 478 // LD code, val is the x_axis value from -32k to +32k
Ownasaurus 6:21365f733399 479 // seems pretty inefficient but hopefully its fast enough
Ownasaurus 12:0cc5d9260495 480 // ----- begin LD analog code -----
Ownasaurus 12:0cc5d9260495 481 /*int val = stick_lx;
Ownasaurus 6:21365f733399 482 float X1_norm;
Ownasaurus 6:21365f733399 483 if(val > 0)
Ownasaurus 6:21365f733399 484 X1_norm = val / 32767.f;
Ownasaurus 8:2479ec34467b 485 else X1_norm = val / -32767.f;
Ownasaurus 8:2479ec34467b 486
Ownasaurus 8:2479ec34467b 487 X1_norm = (X1_norm - dead_zone / 100.0) * 100.0 / (100.0 - dead_zone);
Ownasaurus 8:2479ec34467b 488 if (X1_norm < 0) X1_norm = 0;
Ownasaurus 6:21365f733399 489
Ownasaurus 12:0cc5d9260495 490 char ans = (char)(127 * X1_norm * sensitivity / 100);
Ownasaurus 8:2479ec34467b 491 if (val < 0) ans = -ans;
Ownasaurus 8:2479ec34467b 492 n64_data.x_axis = reverse(ans);
Ownasaurus 6:21365f733399 493
Ownasaurus 6:21365f733399 494 // repeat for y values
Ownasaurus 6:21365f733399 495 val = stick_ly;
Ownasaurus 6:21365f733399 496 if(val > 0)
Ownasaurus 6:21365f733399 497 X1_norm = val / 32767.f;
Ownasaurus 8:2479ec34467b 498 else X1_norm = val / -32767.f;
Ownasaurus 8:2479ec34467b 499
Ownasaurus 8:2479ec34467b 500 X1_norm = (X1_norm - dead_zone / 100.0) * 100.0 / (100.0 - dead_zone);
Ownasaurus 8:2479ec34467b 501 if (X1_norm < 0) X1_norm = 0;
Ownasaurus 6:21365f733399 502
Ownasaurus 12:0cc5d9260495 503 ans = (char)(127 * X1_norm * sensitivity / 100);
Ownasaurus 8:2479ec34467b 504 if (val < 0) ans = -ans;
Ownasaurus 12:0cc5d9260495 505 n64_data.y_axis = reverse(ans);*/
Ownasaurus 12:0cc5d9260495 506 // ----- end of LD analog code -----
Ownasaurus 12:0cc5d9260495 507
Ownasaurus 12:0cc5d9260495 508 // ----- begin nrage replication analog code -----
Ownasaurus 12:0cc5d9260495 509 const float XPAD_MAX = 32768;
Ownasaurus 12:0cc5d9260495 510 const float N64_MAX = (sensitivity > 0) ? 127/sensitivity : 0;
Ownasaurus 12:0cc5d9260495 511 float deadzoneValue = (dead_zone/100.0f) * XPAD_MAX;
Ownasaurus 12:0cc5d9260495 512 float deadzoneRelation = XPAD_MAX / (XPAD_MAX - deadzoneValue);
Ownasaurus 12:0cc5d9260495 513
Ownasaurus 12:0cc5d9260495 514 LSX = LSY = 0; // -128 to +127...
Ownasaurus 12:0cc5d9260495 515 float unscaled_result = 0;
Ownasaurus 6:21365f733399 516
Ownasaurus 12:0cc5d9260495 517 if(stick_lx >= deadzoneValue) // positive = right
Ownasaurus 12:0cc5d9260495 518 {
Ownasaurus 12:0cc5d9260495 519 unscaled_result = (stick_lx - deadzoneValue) * deadzoneRelation;
Ownasaurus 12:0cc5d9260495 520 LSX = (char)(unscaled_result * (N64_MAX / XPAD_MAX));
Ownasaurus 12:0cc5d9260495 521 }
Ownasaurus 12:0cc5d9260495 522 else if(stick_lx <= (-deadzoneValue)) // negative = left
Ownasaurus 12:0cc5d9260495 523 {
Ownasaurus 12:0cc5d9260495 524 stick_lx = -stick_lx; // compute as positive, then negate at the end
Ownasaurus 12:0cc5d9260495 525 unscaled_result = (stick_lx - deadzoneValue) * deadzoneRelation;
Ownasaurus 12:0cc5d9260495 526 LSX = (char)(unscaled_result * (N64_MAX / XPAD_MAX));
Ownasaurus 12:0cc5d9260495 527 LSX = -LSX;
Ownasaurus 12:0cc5d9260495 528 }
Ownasaurus 12:0cc5d9260495 529
Ownasaurus 12:0cc5d9260495 530 if(stick_ly >= deadzoneValue) // positive = up
Ownasaurus 12:0cc5d9260495 531 {
Ownasaurus 12:0cc5d9260495 532 unscaled_result = (stick_ly - deadzoneValue) * deadzoneRelation;
Ownasaurus 12:0cc5d9260495 533 LSY = (char)(unscaled_result * (N64_MAX / XPAD_MAX));
Ownasaurus 12:0cc5d9260495 534 }
Ownasaurus 12:0cc5d9260495 535 else if(stick_ly <= (-deadzoneValue)) // negative = down
Ownasaurus 12:0cc5d9260495 536 {
Ownasaurus 12:0cc5d9260495 537 stick_ly = -stick_ly; // compute as positive, then negate at the end
Ownasaurus 12:0cc5d9260495 538 unscaled_result = (stick_ly - deadzoneValue) * deadzoneRelation;
Ownasaurus 12:0cc5d9260495 539 LSY = (char)(unscaled_result * (N64_MAX / XPAD_MAX));
Ownasaurus 12:0cc5d9260495 540 LSY = -LSY;
Ownasaurus 12:0cc5d9260495 541 }
Ownasaurus 12:0cc5d9260495 542 n64_data.x_axis = reverse(LSX);
Ownasaurus 12:0cc5d9260495 543 n64_data.y_axis = reverse(LSY);
Ownasaurus 12:0cc5d9260495 544
Ownasaurus 12:0cc5d9260495 545 // ----- end nrage replication analog code -----
Ownasaurus 12:0cc5d9260495 546
Ownasaurus 12:0cc5d9260495 547 // Generic analog stick code
Ownasaurus 12:0cc5d9260495 548 /*if(LSX > dead_zone)
Ownasaurus 6:21365f733399 549 {
Ownasaurus 6:21365f733399 550 n64_data.x_axis = reverse(LSX);
Ownasaurus 6:21365f733399 551 }
Ownasaurus 12:0cc5d9260495 552 if(LSY > dead_zone)
Ownasaurus 6:21365f733399 553 {
Ownasaurus 6:21365f733399 554 n64_data.y_axis = reverse(LSY);
Ownasaurus 6:21365f733399 555 }*/
Ownasaurus 12:0cc5d9260495 556 // end of general code
Ownasaurus 3:52b2a7514406 557 }
Ownasaurus 6:21365f733399 558 else // state > 0 so we are in the process of changing controls
Ownasaurus 5:32c8b316582a 559 {
Ownasaurus 6:21365f733399 560 uint64_t b = DetectButton(); // read for button presses (just do linear search)
Ownasaurus 6:21365f733399 561 if(b != 0) /*button was actually is pressed*/
Ownasaurus 6:21365f733399 562 {
Ownasaurus 9:b64b08b130ed 563 //pc.printf("PRESSED\r\n",state); // DEBUG
Ownasaurus 6:21365f733399 564 if(XpadButtonPressed == false)
Ownasaurus 6:21365f733399 565 {
Ownasaurus 6:21365f733399 566 XpadButtonPressed = true;
Ownasaurus 6:21365f733399 567 ChangeButtonMapping(b);
Ownasaurus 6:21365f733399 568 AdvanceState();
Ownasaurus 6:21365f733399 569 }
Ownasaurus 6:21365f733399 570 }
Ownasaurus 6:21365f733399 571 else
Ownasaurus 6:21365f733399 572 {
Ownasaurus 9:b64b08b130ed 573 //pc.printf("NADA\r\n",state); // DEBUG
Ownasaurus 6:21365f733399 574 XpadButtonPressed = false;
Ownasaurus 6:21365f733399 575 }
Ownasaurus 2:c20d8438f206 576 }
Ownasaurus 2:c20d8438f206 577 }
Ownasaurus 0:eb2258e8c4b5 578
Ownasaurus 0:eb2258e8c4b5 579 // 0 is 3 microseconds low followed by 1 microsecond high
Ownasaurus 0:eb2258e8c4b5 580 // 1 is 1 microsecond low followed by 3 microseconds high
Ownasaurus 0:eb2258e8c4b5 581 unsigned int GetMiddleOfPulse()
Ownasaurus 0:eb2258e8c4b5 582 {
Ownasaurus 0:eb2258e8c4b5 583 // wait for line to go high
Ownasaurus 0:eb2258e8c4b5 584 while(1)
Ownasaurus 0:eb2258e8c4b5 585 {
Ownasaurus 0:eb2258e8c4b5 586 if(data.read() == 1) break;
Ownasaurus 0:eb2258e8c4b5 587 }
Ownasaurus 0:eb2258e8c4b5 588
Ownasaurus 0:eb2258e8c4b5 589 // wait for line to go low
Ownasaurus 0:eb2258e8c4b5 590 while(1)
Ownasaurus 0:eb2258e8c4b5 591 {
Ownasaurus 0:eb2258e8c4b5 592 if(data.read() == 0) break;
Ownasaurus 0:eb2258e8c4b5 593 }
Ownasaurus 0:eb2258e8c4b5 594
Ownasaurus 0:eb2258e8c4b5 595 // now we have the falling edge
Ownasaurus 0:eb2258e8c4b5 596 // wait 2 microseconds to be in the middle of the pulse, and read. high --> 1. low --> 0.
Ownasaurus 0:eb2258e8c4b5 597 my_wait_us_asm(2);
Ownasaurus 0:eb2258e8c4b5 598 return (unsigned int) data.read();
Ownasaurus 0:eb2258e8c4b5 599 }
Ownasaurus 0:eb2258e8c4b5 600
Ownasaurus 0:eb2258e8c4b5 601 // continuously read bits until at least 9 are read, confirm valid command, return without stop bit
Ownasaurus 0:eb2258e8c4b5 602 unsigned int readCommand()
Ownasaurus 0:eb2258e8c4b5 603 {
Ownasaurus 0:eb2258e8c4b5 604 unsigned int command = GetMiddleOfPulse(), bits_read = 1;
Ownasaurus 0:eb2258e8c4b5 605
Ownasaurus 0:eb2258e8c4b5 606 while(1) // read at least 9 bits (2 bytes + stop bit)
Ownasaurus 0:eb2258e8c4b5 607 {
Ownasaurus 0:eb2258e8c4b5 608 //my_wait_us_asm(4);
Ownasaurus 0:eb2258e8c4b5 609 command = command << 1; // make room for the new bit
Ownasaurus 0:eb2258e8c4b5 610 //command += data.read(); // place the new bit into the command
Ownasaurus 0:eb2258e8c4b5 611 command += GetMiddleOfPulse();
Ownasaurus 0:eb2258e8c4b5 612 command &= 0x1FF; // remove all except the last 9 bits
Ownasaurus 0:eb2258e8c4b5 613
Ownasaurus 0:eb2258e8c4b5 614 bits_read++;
Ownasaurus 0:eb2258e8c4b5 615
Ownasaurus 0:eb2258e8c4b5 616 if(bits_read >= 9) // only consider when at least a whole command's length has been read
Ownasaurus 0:eb2258e8c4b5 617 {
Ownasaurus 1:3c21da72660d 618 if(command == 0x3 || command == 0x1 || command == 0x1FF || command == 0x5 || command == 0x7)
Ownasaurus 0:eb2258e8c4b5 619 {
Ownasaurus 0:eb2258e8c4b5 620 // 0x3 = 0x1 + stop bit --> get controller state
Ownasaurus 0:eb2258e8c4b5 621 // 0x1 = 0x0 + stop bit --> who are you?
Ownasaurus 0:eb2258e8c4b5 622 // 0x1FF = 0xFF + stop bit --> reset signal
Ownasaurus 1:3c21da72660d 623 // 0x5 = 0x10 + stop bit --> read
Ownasaurus 1:3c21da72660d 624 // 0x7 = 0x11 + stop bit --> write
Ownasaurus 0:eb2258e8c4b5 625 command = command >> 1; // get rid of the stop bit
Ownasaurus 0:eb2258e8c4b5 626 return command;
Ownasaurus 0:eb2258e8c4b5 627 }
Ownasaurus 0:eb2258e8c4b5 628 }
Ownasaurus 0:eb2258e8c4b5 629 }
Ownasaurus 0:eb2258e8c4b5 630 }
Ownasaurus 0:eb2258e8c4b5 631
Ownasaurus 0:eb2258e8c4b5 632 void write_1()
Ownasaurus 0:eb2258e8c4b5 633 {
Ownasaurus 0:eb2258e8c4b5 634 data = 0;
Ownasaurus 0:eb2258e8c4b5 635 my_wait_us_asm(1);
Ownasaurus 0:eb2258e8c4b5 636 data = 1;
Ownasaurus 0:eb2258e8c4b5 637 my_wait_us_asm(3);
Ownasaurus 0:eb2258e8c4b5 638 //pc.printf("1");
Ownasaurus 0:eb2258e8c4b5 639 }
Ownasaurus 0:eb2258e8c4b5 640
Ownasaurus 0:eb2258e8c4b5 641 void write_0()
Ownasaurus 0:eb2258e8c4b5 642 {
Ownasaurus 0:eb2258e8c4b5 643 data = 0;
Ownasaurus 0:eb2258e8c4b5 644 my_wait_us_asm(3);
Ownasaurus 0:eb2258e8c4b5 645 data = 1;
Ownasaurus 0:eb2258e8c4b5 646 my_wait_us_asm(1);
Ownasaurus 0:eb2258e8c4b5 647 //pc.printf("0");
Ownasaurus 0:eb2258e8c4b5 648 }
Ownasaurus 0:eb2258e8c4b5 649
Ownasaurus 0:eb2258e8c4b5 650
Ownasaurus 1:3c21da72660d 651 void SendStop()
Ownasaurus 0:eb2258e8c4b5 652 {
Ownasaurus 0:eb2258e8c4b5 653 data = 0;
Ownasaurus 0:eb2258e8c4b5 654 my_wait_us_asm(1);
Ownasaurus 0:eb2258e8c4b5 655 data = 1;
Ownasaurus 0:eb2258e8c4b5 656 }
Ownasaurus 0:eb2258e8c4b5 657
Ownasaurus 1:3c21da72660d 658 // send a byte from LSB to MSB (proper serialization)
Ownasaurus 1:3c21da72660d 659 void SendByte(unsigned char b)
Ownasaurus 0:eb2258e8c4b5 660 {
Ownasaurus 0:eb2258e8c4b5 661 for(int i = 0;i < 8;i++) // send all 8 bits, one at a time
Ownasaurus 0:eb2258e8c4b5 662 {
Ownasaurus 0:eb2258e8c4b5 663 if((b >> i) & 1)
Ownasaurus 0:eb2258e8c4b5 664 {
Ownasaurus 0:eb2258e8c4b5 665 write_1();
Ownasaurus 0:eb2258e8c4b5 666 }
Ownasaurus 0:eb2258e8c4b5 667 else
Ownasaurus 0:eb2258e8c4b5 668 {
Ownasaurus 0:eb2258e8c4b5 669 write_0();
Ownasaurus 0:eb2258e8c4b5 670 }
Ownasaurus 0:eb2258e8c4b5 671 }
Ownasaurus 0:eb2258e8c4b5 672 }
Ownasaurus 0:eb2258e8c4b5 673
Ownasaurus 1:3c21da72660d 674 void SendIdentity()
Ownasaurus 1:3c21da72660d 675 {
Ownasaurus 1:3c21da72660d 676 // reply 0x05, 0x00, 0x02
Ownasaurus 1:3c21da72660d 677 SendByte(0x05);
Ownasaurus 1:3c21da72660d 678 SendByte(0x00);
Ownasaurus 1:3c21da72660d 679 SendByte(0x02);
Ownasaurus 1:3c21da72660d 680 SendStop();
Ownasaurus 1:3c21da72660d 681 }
Ownasaurus 1:3c21da72660d 682
Ownasaurus 1:3c21da72660d 683 void SendControllerData()
Ownasaurus 1:3c21da72660d 684 {
Ownasaurus 1:3c21da72660d 685 unsigned long data = *(unsigned long*)&n64_data;
Ownasaurus 1:3c21da72660d 686 unsigned int size = sizeof(data) * 8; // should be 4 bytes * 8 = 32 bits
Ownasaurus 1:3c21da72660d 687
Ownasaurus 1:3c21da72660d 688 for(unsigned int i = 0;i < size;i++)
Ownasaurus 1:3c21da72660d 689 {
Ownasaurus 1:3c21da72660d 690 if((data >> i) & 1)
Ownasaurus 1:3c21da72660d 691 {
Ownasaurus 1:3c21da72660d 692 write_1();
Ownasaurus 1:3c21da72660d 693 }
Ownasaurus 1:3c21da72660d 694 else
Ownasaurus 1:3c21da72660d 695 {
Ownasaurus 1:3c21da72660d 696 write_0();
Ownasaurus 1:3c21da72660d 697 }
Ownasaurus 1:3c21da72660d 698 }
Ownasaurus 1:3c21da72660d 699
Ownasaurus 1:3c21da72660d 700 SendStop();
Ownasaurus 1:3c21da72660d 701 }
Ownasaurus 1:3c21da72660d 702
Ownasaurus 0:eb2258e8c4b5 703 int main()
Ownasaurus 0:eb2258e8c4b5 704 {
Ownasaurus 6:21365f733399 705 bool buttonPressed = false;
Ownasaurus 5:32c8b316582a 706
Ownasaurus 2:c20d8438f206 707 pc.printf("\r\nNow loaded! SystemCoreClock = %d Hz\r\n", SystemCoreClock);
Ownasaurus 1:3c21da72660d 708
Ownasaurus 2:c20d8438f206 709 USBHostXpad xpad;
Ownasaurus 2:c20d8438f206 710 if (!xpad.connect()) {
Ownasaurus 2:c20d8438f206 711 pc.printf("Error: XBox controller not found.\n");
Ownasaurus 1:3c21da72660d 712 }
Ownasaurus 2:c20d8438f206 713
Ownasaurus 2:c20d8438f206 714 xpad.attachEvent(onXpadEvent);
Ownasaurus 2:c20d8438f206 715 xpad.led(USBHostXpad::LED1_ON);
Ownasaurus 0:eb2258e8c4b5 716
Ownasaurus 0:eb2258e8c4b5 717 while(1)
Ownasaurus 0:eb2258e8c4b5 718 {
Ownasaurus 6:21365f733399 719 if(state == NORMAL)
Ownasaurus 0:eb2258e8c4b5 720 {
Ownasaurus 6:21365f733399 721 if(!button) // user wants to change controls
Ownasaurus 6:21365f733399 722 {
Ownasaurus 6:21365f733399 723 if(!buttonPressed) // make sure it's a separate button press
Ownasaurus 6:21365f733399 724 {
Ownasaurus 10:02dbdace7cfb 725 myled = true;
Ownasaurus 6:21365f733399 726 buttonPressed = true;
Ownasaurus 6:21365f733399 727 state++;
Ownasaurus 6:21365f733399 728 continue;
Ownasaurus 6:21365f733399 729 }
Ownasaurus 6:21365f733399 730 }
Ownasaurus 6:21365f733399 731 else
Ownasaurus 6:21365f733399 732 {
Ownasaurus 6:21365f733399 733 buttonPressed = false;
Ownasaurus 6:21365f733399 734 }
Ownasaurus 6:21365f733399 735
Ownasaurus 6:21365f733399 736 // Set pin mode to input
Ownasaurus 6:21365f733399 737 data.input();
Ownasaurus 6:21365f733399 738
Ownasaurus 6:21365f733399 739 USBHost::poll();
Ownasaurus 6:21365f733399 740
Ownasaurus 6:21365f733399 741 __disable_irq(); // Disable Interrupts
Ownasaurus 6:21365f733399 742
Ownasaurus 6:21365f733399 743 // Read 64 command
Ownasaurus 6:21365f733399 744 unsigned int cmd = readCommand();
Ownasaurus 6:21365f733399 745
Ownasaurus 6:21365f733399 746 my_wait_us_asm(2); // wait a small amount of time before replying
Ownasaurus 6:21365f733399 747
Ownasaurus 6:21365f733399 748 //-------- SEND RESPONSE
Ownasaurus 6:21365f733399 749 // Set pin mode to output
Ownasaurus 6:21365f733399 750 data.output();
Ownasaurus 6:21365f733399 751
Ownasaurus 10:02dbdace7cfb 752 //pc.printf("cmd = 0x%02X\r\n",cmd);
Ownasaurus 10:02dbdace7cfb 753
Ownasaurus 6:21365f733399 754 switch(cmd)
Ownasaurus 6:21365f733399 755 {
Ownasaurus 6:21365f733399 756 case 0x00: // identity
Ownasaurus 10:02dbdace7cfb 757 //pc.printf("I got an 0x00!\r\n");
Ownasaurus 10:02dbdace7cfb 758 SendIdentity();
Ownasaurus 10:02dbdace7cfb 759 break;
Ownasaurus 6:21365f733399 760 case 0xFF: // reset
Ownasaurus 10:02dbdace7cfb 761 //pc.printf("I got an 0xFF!\r\n");
Ownasaurus 6:21365f733399 762 SendIdentity();
Ownasaurus 6:21365f733399 763 break;
Ownasaurus 6:21365f733399 764 case 0x01: // poll for state
Ownasaurus 6:21365f733399 765 SendControllerData();
Ownasaurus 6:21365f733399 766 break;
Ownasaurus 6:21365f733399 767 default:
Ownasaurus 6:21365f733399 768 // we do not process the read and write commands (memory pack)
Ownasaurus 6:21365f733399 769 break;
Ownasaurus 6:21365f733399 770 }
Ownasaurus 6:21365f733399 771 __enable_irq(); // Enable Interrupts
Ownasaurus 6:21365f733399 772 //-------- DONE SENDING RESPOSE
Ownasaurus 0:eb2258e8c4b5 773 }
Ownasaurus 6:21365f733399 774 else
Ownasaurus 6:21365f733399 775 {
Ownasaurus 6:21365f733399 776 if(!button) // user wants to cancel and return to regular mode
Ownasaurus 6:21365f733399 777 {
Ownasaurus 6:21365f733399 778 if(!buttonPressed) // make sure it's a separate button press
Ownasaurus 6:21365f733399 779 {
Ownasaurus 7:65d1a7a3948b 780 state = NORMAL;
Ownasaurus 10:02dbdace7cfb 781 myled = false;
Ownasaurus 6:21365f733399 782 buttonPressed = true;
Ownasaurus 6:21365f733399 783 continue;
Ownasaurus 6:21365f733399 784 }
Ownasaurus 6:21365f733399 785 }
Ownasaurus 6:21365f733399 786 else
Ownasaurus 6:21365f733399 787 {
Ownasaurus 6:21365f733399 788 buttonPressed = false;
Ownasaurus 6:21365f733399 789 }
Ownasaurus 6:21365f733399 790
Ownasaurus 9:b64b08b130ed 791 //pc.printf("State = %d\r\n",state); // DEBUG
Ownasaurus 9:b64b08b130ed 792
Ownasaurus 10:02dbdace7cfb 793
Ownasaurus 6:21365f733399 794 USBHost::poll();
Ownasaurus 10:02dbdace7cfb 795 //wait(0.1); // too long of a wait. caused xbone controller issues due to timeouts
Ownasaurus 6:21365f733399 796
Ownasaurus 10:02dbdace7cfb 797 if(state == NORMAL) // about to return to normal operation, make sure the LED turns off
Ownasaurus 6:21365f733399 798 {
Ownasaurus 6:21365f733399 799 myled = false;
Ownasaurus 6:21365f733399 800 XpadButtonPressed = false;
Ownasaurus 6:21365f733399 801 }
Ownasaurus 6:21365f733399 802 }
Ownasaurus 0:eb2258e8c4b5 803 }
Ownasaurus 0:eb2258e8c4b5 804 }