forked from lshachar/Arduino_Fanatec_Wheel
-
Notifications
You must be signed in to change notification settings - Fork 0
/
arduino_fanatec_wheel.ino
444 lines (400 loc) · 16.3 KB
/
arduino_fanatec_wheel.ino
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234
235
236
237
238
239
240
241
242
243
244
245
246
247
248
249
250
251
252
253
254
255
256
257
258
259
260
261
262
263
264
265
266
267
268
269
270
271
272
273
274
275
276
277
278
279
280
281
282
283
284
285
286
287
288
289
290
291
292
293
294
295
296
297
298
299
300
301
302
303
304
305
306
307
308
309
310
311
312
313
314
315
316
317
318
319
320
321
322
323
324
325
326
327
328
329
330
331
332
333
334
335
336
337
338
339
340
341
342
343
344
345
346
347
348
349
350
351
352
353
354
355
356
357
358
359
360
361
362
363
364
365
366
367
368
369
370
371
372
373
374
375
376
377
378
379
380
381
382
383
384
385
386
387
388
389
390
391
392
393
394
395
396
397
398
399
400
401
402
403
404
405
406
407
408
409
410
411
412
413
414
415
416
417
418
419
420
421
422
423
424
425
426
427
428
429
430
431
432
433
434
435
436
437
438
439
440
441
442
443
444
#include "pins_arduino.h"
#include <avr/pgmspace.h>
#define HAS_TM1637_DISPLAY // comment out if you're not using a TM1637 4 digits 7 segment display
#ifdef HAS_TM1637_DISPLAY
#include <TM1637Display.h>
#define TM_CLKPIN 3
#define TM_DIOPIN 4
#define TM_BRIGHTNESS 5 // (0..7), sets the brightness of the display. 0=min, 7=max
TM1637Display display = TM1637Display(TM_CLKPIN, TM_DIOPIN);
uint8_t TM_data[] = { 0x00, 0x00, 0x00, 0x00 };
const uint8_t TM_race[] = { 0x50, 0x77, 0x58, 0x79 };
#define DISPLAY_CRC8_ON_ALPHANUMERIC // if you'd like to get 'CrC' message on the alphanumeric display, each time there's a crc8 mismatch, which means bad SPI communication with the wheelbase. (message anyways gets sent to serial monitor.) My advice: Keep this uncommented until everything works really well. then comment it, because there will always be some CRC errors and that's fine.
const uint8_t TM_crc[] = {0x39, 0x50, 0x39};
#endif
#define HAS_ANALOG_DPAD
#define DEBUG_ANALOG_DPAD // print the DPAD value on the alphanumeric display. Only relevant if you have an analog dpad, and only when trying to get the DPAD working. once it's working - uncomment this. (Dpad value is anyways sent to serial monitor)
#ifdef HAS_ANALOG_DPAD
#define DPADPIN A0
int prevDpadVal = 0;
#endif
#define dataLength 33
#define CS_ISR 2 // connect SPI Cable Select pin to Arduino's D2 & D10. (See schematics)
#define PRINTBIN(Num) for (uint32_t t = (1UL << (sizeof(Num) * 8) - 1); t; t >>= 1) Serial.write(Num& t ? '1' : '0'); // Prints a binary number with leading zeros (Automatic Handling)
#define HASBUTTONS // use digital and analog pins for steering wheel buttons. Note: Pins A7 and A6 do not have an internal pullup resistor. Serial data pins: D0, D1. SPI pins: D2, D10, D11, D12, D13. Display Pins: D3, D4. The rest of digital and analog pins can be used for buttons. (also AFAIK A6 and A7 can only be used for analogRead() )
#ifdef HASBUTTONS
#define buttonsnum 6 // how many buttons are you using?
uint8_t buttonsPins[] = { A5, A4, A3, A2, 8, 9}; // what arduino pins are you using?
uint8_t buttonsBits[] = { 8, 5, 13, 11, 9, 12}; // what bits do you want each button to affect? use last comment in this file as reference.
#endif
uint8_t mosiBuf[dataLength]; // buffer for the incoming data on the mosi line.
volatile unsigned long lastPrintMillis = 0;
int selectedButtonByte = 2; // button bytes are 3rd to 5th. initialize to 1st relevant byte.
uint8_t incByte, prevPrintedByte, prevAlphaDisp[3];
volatile uint8_t isrIndex = 0;
unsigned long delayMillis = 400; // wait at least the delay time since last spi communication before printing out whatever came in.
// CRC lookup table with polynomial of 0x131
PROGMEM const unsigned char _crc8_table[256] = {
0, 94, 188, 226, 97, 63, 221, 131,
194, 156, 126, 32, 163, 253, 31, 65,
157, 195, 33, 127, 252, 162, 64, 30,
95, 1, 227, 189, 62, 96, 130, 220,
35, 125, 159, 193, 66, 28, 254, 160,
225, 191, 93, 3, 128, 222, 60, 98,
190, 224, 2, 92, 223, 129, 99, 61,
124, 34, 192, 158, 29, 67, 161, 255,
70, 24, 250, 164, 39, 121, 155, 197,
132, 218, 56, 102, 229, 187, 89, 7,
219, 133, 103, 57, 186, 228, 6, 88,
25, 71, 165, 251, 120, 38, 196, 154,
101, 59, 217, 135, 4, 90, 184, 230,
167, 249, 27, 69, 198, 152, 122, 36,
248, 166, 68, 26, 153, 199, 37, 123,
58, 100, 134, 216, 91, 5, 231, 185,
140, 210, 48, 110, 237, 179, 81, 15,
78, 16, 242, 172, 47, 113, 147, 205,
17, 79, 173, 243, 112, 46, 204, 146,
211, 141, 111, 49, 178, 236, 14, 80,
175, 241, 19, 77, 206, 144, 114, 44,
109, 51, 209, 143, 12, 82, 176, 238,
50, 108, 142, 208, 83, 13, 239, 177,
240, 174, 76, 18, 145, 207, 45, 115,
202, 148, 118, 40, 171, 245, 23, 73,
8, 86, 180, 234, 105, 55, 213, 139,
87, 9, 235, 181, 54, 104, 138, 212,
149, 203, 41, 119, 244, 170, 72, 22,
233, 183, 85, 11, 136, 214, 52, 106,
43, 117, 151, 201, 74, 20, 246, 168,
116, 42, 200, 150, 21, 75, 169, 247,
182, 232, 10, 84, 215, 137, 107, 53
};
// Uni hub packet (change to other steering wheels in setup() )
uint8_t returnData[dataLength] = { 0xA5, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xfc };
// return CRC8 from buf
uint8_t crc8(const uint8_t* buf, uint8_t length) {
uint8_t crc = 0xff;
while (length) {
crc = pgm_read_byte_near(_crc8_table + (*buf ^ crc));
buf++;
length--;
}
return crc;
}
void setup()
{
pinMode(MISO, OUTPUT); // usually when using SPI, arduino will automatically define MISO as output, but not when doing SPI slave.
pinMode(SCK, INPUT);
pinMode(MOSI, INPUT);
pinMode(CS_ISR, INPUT); // connecting CS_ISR pin (D2) to the SS pin (D10) is crucial. See the schematics.
pinMode(SS, INPUT);
#ifdef HASBUTTONS
for (int i = 0; i < buttonsnum; i++) {
pinMode(buttonsPins[i], INPUT_PULLUP);
}
#endif
returnData[1] = {0x03}; // for ClubSport Porshe 918 RSR - This is the only option that I'm implementing right now.
// {0x01} for BMW M3 GT2, {0x02} for ClubSport FORMULA, (0x04) for Uni hub
Serial.begin(250000);
#ifdef HAS_ANALOG_DPAD
pinMode(DPADPIN, INPUT);
#endif
#ifdef HAS_TM1637_DISPLAY
display.clear();
display.setBrightness(TM_BRIGHTNESS);
display.setSegments(TM_race);
delay(1000);
display.clear();
#endif
attachInterrupt(digitalPinToInterrupt(CS_ISR), cableselect, RISING);
// SPCR BYTE should be: 11000100 note to self: by raw_capture.ino and fanatec.cpp spi settings, of btClubSportWheel by Darknao, SPI settings are SPI_Mode0 & MSBFIRST. but with logic scope I see that CPHA 1 (falling!) is used by wheel base, which means SPI_MODE1. (and MSBFIRST)
// (Mode 1 - clock is normally low (CPOL = 0), and the data is sampled on the transition from high to low (trailing edge) (CPHA = 1))
SPCR |= _BV(SPE); // turn on SPI
SPCR |= _BV(SPIE); // turn on interrupts
SPCR |= _BV(CPHA); //turns on CPHA. as I found the CSW wheelbase to use it, with logic scope.
Serial.print("SPCR byte (binary):");
Serial.println(SPCR, BIN); //prints byte as binary
}
void cableselect() { // When CS line goes high - the rim should get ready to transmit the next returnData buffer, right from the begining. (so that the first byte (0xA5) will be sent out on the first Clock cycle (and after CS line went Low)
SPCR &= ~_BV(SPIE); // turn OFF interrupts
SPDR = returnData[0]; // load first byte into SPDR single-byte's buffer
isrIndex = 0; // on next SPI interrupt(SPI_STC_vect), load the 2nd byte
SPCR |= _BV(SPIE); // turn on interrupts
}
// SPI interrupt routine
ISR(SPI_STC_vect) // Note: this routine takes 6 us, and happens once 8 bits are recieved through SPI.
{
byte c = SPDR;
mosiBuf[isrIndex] = c;
isrIndex++;
if (isrIndex >= dataLength) {
isrIndex = 0;
}
SPDR = returnData[isrIndex];
}
void loop() {
readSerial();
readButtons();
calcOutgoingCrc();
printButtonByteToSerial();
checkIncomingCrc();
refreshAlphanumericDisplays();
}
void readButtons() {
#ifdef HASBUTTONS
for (int i = 0; i < buttonsnum; i++) {
if (!digitalRead(buttonsPins[i])) { // if this input is low the button is pressed. Reverse logic: all button inputs use the internal input pullup, and pressing the button completes the path to ground)
buttonBitChange(buttonsBits[i], true); // raise the correct button bit, as defined in buttonsBits[]
}
else {
buttonBitChange(buttonsBits[i], false); // drop bit
}
}
#endif
#ifdef HAS_ANALOG_DPAD
/*
VALUE MIDPOINT BUTTON DpadVal
1023 933.5 nothing 0
844 763 right 1
682 639.5 left 2
597 505.5 left+right (calibrate center) 3
414 299 down 4
184 164.5 up 5
145 72.5 up+down (menu) 6
0 0 Dpad button 7
*/
//In case you've used different resistors to what I used, uncomment the serial print command here to find your analog read values:
//Serial.println(analogRead(DPADPIN));
int DpadRead = analogRead(DPADPIN);
int DpadVal = 0;
if (DpadRead > 933) DpadVal = 0; else
if (DpadRead > 763) DpadVal = 1; else
if (DpadRead > 639) DpadVal = 2; else
if (DpadRead > 505) DpadVal = 3; else
if (DpadRead > 299) DpadVal = 4; else
if (DpadRead > 164) DpadVal = 5; else
if (DpadRead > 72) DpadVal = 6; else
DpadVal = 7;
if (DpadVal != prevDpadVal) { // only if button has changed, do something
Serial.print("Dpad button:");
Serial.println(DpadVal);
#if defined HAS_ANALOG_DPAD && defined HAS_TM1637_DISPLAY && defined DEBUG_ANALOG_DPAD
display.showNumberDec(DpadVal, false,1,3); // print the dpad value on the lcd screen
#endif
dPadBitChange(prevDpadVal, false); // turn the previous Dpad button bit off.
dPadBitChange(DpadVal, true); // turn the current Dpad button bit on.
}
prevDpadVal = DpadVal;
#endif
}
void dPadBitChange(uint8_t dPadVal, bool bitOn) {
// sets (raises or lowers) the correct button bits according to the Dpad button that was pressed or released
switch (dPadVal) {
case 0: break;
case 1: // right
buttonBitChange(3, bitOn); break;
case 2: // left
buttonBitChange(2, bitOn); break;
case 3: // left+right (calibrate wheel center point)
buttonBitChange(18, bitOn); // Dpad button
buttonBitChange(19, bitOn); break; // Joystick button
case 4: // down
buttonBitChange(4, bitOn); break;
case 5: // up
buttonBitChange(1, bitOn); break;
case 6: // up+down (menu)
buttonBitChange(22, bitOn); break;
case 7: // Dpad button
buttonBitChange(18, bitOn); break;
}
}
void buttonBitChange(uint8_t buttonBit, bool bitOn) {
// changes a selected bit in one of the 3 button bytes to either on (1) or off (0). Valid values for buttonBit is 1 to 24. See buttons list in last comment.
if (bitOn) {
returnData[2 + ((buttonBit - 1) / 8)] |= (1 << (((buttonBit - 1) % 8)));
}
else {
returnData[2 + ((buttonBit - 1) / 8)] &= ~(1 << (((buttonBit - 1) % 8)));
}
}
void readSerial()
// reads user inputs from serial connection. i = print mosI data, o = print misO data, a = view what is displayed on the rim's alphanumeric display. letters (A,B,C) = selects corresponding button byte (first second or third), numbers (1..7) = changes bits inside the selected byte. So user can send button presses to the wheelbase without having any physical buttons attached.
{
if (Serial.available() > 0) {
incByte = Serial.read();
Serial.println((char)incByte);
if (incByte == 'i')
printmosibuf();
if (incByte == 'o')
printmisobuf();
if (incByte == 'd')
refreshAlphanumericDisplays();
if ((incByte >= 'A') && (incByte <= 'J')) { // send A,B,C to choose 1st, 2nd, 3rd button byte
selectedButtonByte = (incByte - 'A' + 2); // first button byte is 3rd in array, or cell no 2 to cell no 4 in array
Serial.print("Selected button byte:");
Serial.println(selectedButtonByte);
PRINTBIN(returnData[selectedButtonByte]);
Serial.print(" ");
printHex(returnData[selectedButtonByte], 2);
Serial.println();
}
if ((incByte >= '1') && (incByte <= '8'))
{
returnData[selectedButtonByte] ^= (1 << (incByte - '1')); // toggles bit correcsponding to number read by serial print
printmisobuf();
}
}
}
void printHex(int num, int precision) {
char tmp[16];
char format[128];
sprintf(format, "0x%%.%dX", precision);
sprintf(tmp, format, num);
Serial.print(tmp);
}
void refreshAlphanumericDisplays() {
// display current alphanumeric information through serial port / TM1637 display
bool displaychanged = false;
for (int i = 2; i <= 4; i++) { // cells 2 to 4 in miso data is alphanumeric data
if (mosiBuf[i] != prevAlphaDisp[i - 2]) { // if anything on the display changed, reprint
displaychanged = true;
break;
}
}
if (displaychanged) {
for (int i = 2; i <= 4; i++) {
uint8_t p = mosiBuf[i] & 0x7F; // remove the . (dot) bit
switch (p) {
case 0x3f: Serial.print("0"); break;
case 0x6: Serial.print("1"); break;
case 0x5b: Serial.print("2"); break;
case 0x4f: Serial.print("3"); break;
case 0x66: Serial.print("4"); break;
case 0x6d: Serial.print("S"); break;
case 0x7d: Serial.print("6"); break;
case 0x7: Serial.print("7"); break;
case 0x7f: Serial.print("8"); break;
case 0x6f: Serial.print("9"); break;
case 0x39: Serial.print("C"); break;
case 0x38: Serial.print("L"); break;
case 0x8: Serial.print("_"); break;
case 0x79: Serial.print("E"); break;
case 0x54: Serial.print("n"); break;
case 0x71: Serial.print("F"); break;
case 0x76: Serial.print("H"); break;
case 0x5c: Serial.print("o"); break;
case 0x77: Serial.print("A"); break;
case 0x7c: Serial.print("b"); break;
case 0x5e: Serial.print("d"); break;
case 0x50: Serial.print("r"); break;
case 0x30: Serial.print("I"); break;
case 0x73: Serial.print("P"); break;
case 0x78: Serial.print("t"); break;
case 0x40: Serial.print("-"); break;
case 0x3e: Serial.print("u"); break;
case 0x2A: Serial.print("*"); break; // this should really be a floating 'o' (displayed on the top square) but I couldn't find an ascii character for that
default: printHex(p, 2); break;
}
if (mosiBuf[i] & 0x80) // select only the . (dot) bit
Serial.print(". ");
else
Serial.print(" ");
prevAlphaDisp[i - 2] = mosiBuf[i];
}
Serial.println();
#ifdef HAS_TM1637_DISPLAY
for (int i = 2; i <= 4; i++) {
TM_data[i-2] = mosiBuf[i];
}
display.setSegments(TM_data);
#endif
}
}
void printButtonByteToSerial() {
// Prints the selected button byte to Serial, if it was changed. The button byte can be selected by sending either A,B or C through the serial monitor. The bits in the selected button byte can either be changed by the serial monitor (sending 1 to 7 raises / lowers a specific bit,) or by pressing one of the physical buttons, if you have any attached.
if (millis() > lastPrintMillis + delayMillis) {
if (prevPrintedByte != returnData[selectedButtonByte]) {
PRINTBIN(returnData[selectedButtonByte]);
Serial.print(" ");
printHex(returnData[selectedButtonByte], 2);
Serial.println();
}
prevPrintedByte = returnData[selectedButtonByte];
lastPrintMillis = millis();
}
}
void printmosibuf() {
Serial.print("MOSI:");
for (int i = 0; i < dataLength; i++)
{
printHex(mosiBuf[i], 2);
//Serial.print(mosiBuf[i],HEX);
Serial.print(" ");
}
Serial.println();
}
void printmisobuf() {
Serial.print("MISO:");
for (int i = 0; i < dataLength; i++) {
printHex(returnData[i], 2);
//Serial.print(returnData[i], HEX);
Serial.print(" ");
}
Serial.println();
}
void calcOutgoingCrc() {
returnData[dataLength - 1] = crc8(returnData, dataLength - 1); // calculates crc8 for outgoing packet
}
void checkIncomingCrc() { //crc check for incoming data
uint8_t crc = crc8(mosiBuf, dataLength - 1); //Serial.print("calc crc"); //Serial.println(crc,HEX);
if (crc != mosiBuf[dataLength - 1]) {
Serial.println("_____________incoming data crc8 mismatch!________");
printmosibuf();
#ifdef DISPLAY_CRC8_ON_ALPHANUMERIC
display.setSegments(TM_crc);
#endif
}
}
/*
Clubsport wheel buttons, by bit, from 3rd byte on miso array to 5th byte.
The buttons numbers appear in the fanatec driver (mouse settings tab), and also in the 'clubsport Porsche 911 buttons.png' file.
A
1 D-pad Up
2 D-pad Left
3 D-pad Right
4 D-pad Down
5 Button 11
6 Button 3
7 Button 6
8 Button 4
B
9(1) Right Paddle
10(2) Button 2 (top left, right one)
11(3) Button 8 (bottom left, lower)
12(4) Left paddle
13(5) Button 1 (top left, left one)
14(6) Button 5 (bottom left, higher)
15(7) Button 9 (3 buttons in triangle, left)
16(8) Button 10 (3 buttons in triangle, right)
C
17(1) Button 21 in contentmanager. Does not show up in fanatec's driver
18(2) D-pad Button
19(3) Joystick Button
20(4) Button 7 (3 buttons in triangle, top)
21(5) Button 27 in contentmanager. Does not show up in fanatec's driver
22(6) Menu button. Button 28 in contentmanager. Does not show up in fanatec's driver)
23(7)
24(8)
example: button 8 on fanatec's driver, number 11 on this list, is controlled by 3rd bit on the 2nd byte, of the 3 bytes that control buttons.
C6 - enters menu
B8C6 - enters shifter calibration mode
To calibrate wheel center,
A. Using the serial monitor, send:
C6 6 23 23 6 6. (each space here means: hit return)
B. Using the Dpad:
Enter the menu by pressing both up+down bubttons on the Dpad,
S_1 will appear on the serial monitor and on the alphanumeric display,
Press both left+right buttons on the Dpad to calibrate wheel center,
Press both up+down on the Dpad to exit menu.
*/