-
Notifications
You must be signed in to change notification settings - Fork 0
/
ArduinoWExtension.cpp
99 lines (83 loc) · 2.52 KB
/
ArduinoWExtension.cpp
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
/*
Copyright (C) 2012 Gauthier Monserand
This file is part of ArduinoWExtension.
ArduinoWExtension is free software: you can redistribute it and/or modify
it under the terms of the GNU General Public License as published by
the Free Software Foundation, either version 3 of the License, or
(at your option) any later version.
ArduinoWExtension is distributed in the hope that it will be useful,
but WITHOUT ANY WARRANTY; without even the implied warranty of
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
GNU General Public License for more details.
You should have received a copy of the GNU General Public License
along with ArduinoWExtension. If not, see <http://www.gnu.org/licenses/>.
*/
#include <Arduino.h>
#include <Wire.h>
#include "ArduinoWExtension.h"
void ArduinoWExtension::begin()
{
write(0x55, 0xF0);
write(0x00, 0xFB);
update();
}
bool ArduinoWExtension::update()
{
int count = 0;
wpacket_t packet;
Wire.requestFrom (0x52, 6);
for (int i = 0; i < 6; i++) {
if (!Wire.available())
return false;
packet[i] = Wire.read();
}
decode(packet);
write(0x00, 0x00);
}
void ArduinoWExtension::write(uint8_t data, uint8_t location)
{
Wire.beginTransmission(0x52);
Wire.write(location);
Wire.write(data);
Wire.endTransmission();
delay(10);
}
#define WPACKET_BIT(byte, bit) !((packet[byte] >> bit) & 1)
void ArduinoWNunchuk::decode(const wpacket_t packet) {
joy.x = packet[0];
joy.y = packet[1];
giro.x = packet[2] << 2 + WPACKET_BIT(5, 2) << 1 + WPACKET_BIT(5, 3);
giro.x = packet[3] << 2 + WPACKET_BIT(5, 4) << 1 + WPACKET_BIT(5, 5);
giro.x = packet[3] << 2 + WPACKET_BIT(5, 6) << 1 + WPACKET_BIT(5, 7);
button_z = WPACKET_BIT(5, 0);
button_c = WPACKET_BIT(5, 1);
}
void ArduinoWGuitar::decode(const wpacket_t packet) {
button_p = WPACKET_BIT(4, 2);
button_l = WPACKET_BIT(4, 4);
button_g = WPACKET_BIT(5, 4);
button_r = WPACKET_BIT(5, 6);
button_y = WPACKET_BIT(5, 3);
button_b = WPACKET_BIT(5, 5);
button_o = WPACKET_BIT(5, 7);
button_sd = WPACKET_BIT(4, 6);
button_su = WPACKET_BIT(5, 0);
joy.x = (packet[0]&63)-32;
joy.y = (packet[1]&63)-32;
whammy_bar = (packet[3])&15;
}
void ArduinoWDebugger::decode(const wpacket_t packet) {
for (uint8_t i = 0; i < 6; i++) {
uint8_t j = packet[i];
uint8_t k = 8;
while (j) {
j = j >> 1;
k--;
};
if (k == 8) { k--; }
while(k) { Serial.print("0"); k--; }
Serial.print(packet[i], BIN);
Serial.print(" ");
}
Serial.println("");
}