|
|
|
|
@@ -28,13 +28,17 @@ struct ButtonInfo {
|
|
|
|
|
};
|
|
|
|
|
|
|
|
|
|
struct arrow arrowTable[4];
|
|
|
|
|
struct arrow oldestArrow;
|
|
|
|
|
struct arrow newestArrow;
|
|
|
|
|
struct arrow oldestXArrow;
|
|
|
|
|
struct arrow newestXArrow;
|
|
|
|
|
struct arrow oldestYArrow;
|
|
|
|
|
struct arrow newestYArrow;
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
#define ButtonInfoTableSize 9
|
|
|
|
|
struct ButtonInfo buttonInfoTable[ButtonInfoTableSize];
|
|
|
|
|
|
|
|
|
|
Hat last = Hat::CENTER;
|
|
|
|
|
|
|
|
|
|
void perms() {
|
|
|
|
|
if(val == 0){
|
|
|
|
|
@@ -63,8 +67,8 @@ void setup()
|
|
|
|
|
rapidFireTable[RapidFireTableSize/2] = 2;
|
|
|
|
|
SwitchControlLibrary();
|
|
|
|
|
|
|
|
|
|
MsTimer2::set(1, perms);
|
|
|
|
|
MsTimer2::start();
|
|
|
|
|
//MsTimer2::set(1, perms);
|
|
|
|
|
//MsTimer2::start();
|
|
|
|
|
|
|
|
|
|
setupButton(&(buttonInfoTable[0]), 3, Button::B);
|
|
|
|
|
setupButton(&(buttonInfoTable[1]), 4, Button::X);
|
|
|
|
|
@@ -95,11 +99,17 @@ void setup()
|
|
|
|
|
arrowTable[i].newer = NULL;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
oldestArrow.older = NULL;
|
|
|
|
|
oldestArrow.newer = &newestArrow;
|
|
|
|
|
oldestArrow.arrowSymbol = Hat::CENTER;
|
|
|
|
|
newestArrow.older = &oldestArrow;
|
|
|
|
|
newestArrow.newer = NULL;
|
|
|
|
|
oldestXArrow.older = NULL;
|
|
|
|
|
oldestXArrow.newer = &newestXArrow;
|
|
|
|
|
oldestXArrow.arrowSymbol = Hat::CENTER;
|
|
|
|
|
newestXArrow.older = &oldestXArrow;
|
|
|
|
|
newestXArrow.newer = NULL;
|
|
|
|
|
|
|
|
|
|
oldestYArrow.older = NULL;
|
|
|
|
|
oldestYArrow.newer = &newestYArrow;
|
|
|
|
|
oldestYArrow.arrowSymbol = Hat::CENTER;
|
|
|
|
|
newestYArrow.older = &oldestYArrow;
|
|
|
|
|
newestYArrow.newer = NULL;
|
|
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
@@ -116,6 +126,13 @@ void handleButtonInput(ButtonInfo *but){
|
|
|
|
|
but->prev = but->current;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
void moveHat(Hat dir){
|
|
|
|
|
if(last != dir){
|
|
|
|
|
SwitchControlLibrary().MoveHat(static_cast<uint8_t>(dir));
|
|
|
|
|
last = dir;
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
void loop()
|
|
|
|
|
{
|
|
|
|
|
val = digitalRead(2);
|
|
|
|
|
@@ -136,24 +153,63 @@ void loop()
|
|
|
|
|
|
|
|
|
|
for (int i=0; i<4; i++){
|
|
|
|
|
arrowTable[i].current = digitalRead(arrowTable[i].pinNumber);
|
|
|
|
|
if(arrowTable[i].prev==1 && arrowTable[i].current==0){
|
|
|
|
|
// add arrow to the tail of linked list
|
|
|
|
|
arrowTable[i].older = newestArrow.older;
|
|
|
|
|
arrowTable[i].newer = &newestArrow;
|
|
|
|
|
newestArrow.older->newer = &(arrowTable[i]);
|
|
|
|
|
newestArrow.older = &(arrowTable[i]);
|
|
|
|
|
}
|
|
|
|
|
else if (arrowTable[i].prev==0 && arrowTable[i].current==1){
|
|
|
|
|
arrowTable[i].newer->older = arrowTable[i].older;
|
|
|
|
|
arrowTable[i].older->newer = arrowTable[i].newer;
|
|
|
|
|
arrowTable[i].newer = NULL;
|
|
|
|
|
arrowTable[i].older = NULL;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
if(arrowTable[1].current == 0){
|
|
|
|
|
if(arrowTable[3].current == 0){
|
|
|
|
|
if(arrowTable[0].current == 0){
|
|
|
|
|
moveHat(Hat::TOP);
|
|
|
|
|
}
|
|
|
|
|
else{
|
|
|
|
|
if(arrowTable[2].current == 0){
|
|
|
|
|
moveHat(Hat::BOTTOM);
|
|
|
|
|
}
|
|
|
|
|
else{
|
|
|
|
|
moveHat(Hat::CENTER);
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
else{
|
|
|
|
|
if(arrowTable[0].current == 0){
|
|
|
|
|
moveHat(Hat::TOP_LEFT);
|
|
|
|
|
}
|
|
|
|
|
else{
|
|
|
|
|
if(arrowTable[2].current == 0){
|
|
|
|
|
moveHat(Hat::BOTTOM_LEFT);
|
|
|
|
|
}
|
|
|
|
|
else{
|
|
|
|
|
moveHat(Hat::LEFT);
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
else{
|
|
|
|
|
if(arrowTable[3].current == 0){
|
|
|
|
|
if(arrowTable[0].current == 0){
|
|
|
|
|
moveHat(Hat::TOP_RIGHT);
|
|
|
|
|
}
|
|
|
|
|
else{
|
|
|
|
|
if(arrowTable[2].current == 0){
|
|
|
|
|
moveHat(Hat::BOTTOM_RIGHT);
|
|
|
|
|
}
|
|
|
|
|
else{
|
|
|
|
|
moveHat(Hat::RIGHT);
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
else{
|
|
|
|
|
if(arrowTable[0].current == 0){
|
|
|
|
|
moveHat(Hat::TOP);
|
|
|
|
|
}
|
|
|
|
|
else{
|
|
|
|
|
if(arrowTable[2].current == 0){
|
|
|
|
|
moveHat(Hat::BOTTOM);
|
|
|
|
|
}
|
|
|
|
|
else{
|
|
|
|
|
moveHat(Hat::CENTER);
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
arrowTable[i].prev = arrowTable[i].current;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
SwitchControlLibrary().MoveHat(static_cast<uint8_t>(newestArrow.older->arrowSymbol));
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|