受け取りのコントローラのプログラム

Dependencies:   TextLCD mbed MultiSerial Pswitch_Lib

main.cpp

Committer:
lilac0112_1
Date:
2014-09-23
Revision:
4:39edc16ee5c3
Parent:
3:cfd7cd361088
Child:
5:a5c324942570

File content as of revision 4:39edc16ee5c3:

#include "mbed.h"
#include "TextLCD.h"
#include "MultiSerial.h"
#include "Pswitch.h"

#define DATA_NUM 2
#define KEYCODE 0xAA
#define INTERVAL 12

enum HAND{RIGHT=0, LEFT};
enum FINGER{INDEX=0, MIDDLE};
enum COMPASS{NORTH=0, EAST, SOUTH, WEST};
enum COLOR{YELLOW=0, RED, GREEN, BLUE};

uint8_t INdata[DATA_NUM]={0}, EXdata[DATA_NUM]={0};
volatile uint8_t count=0;
bool SW;

void SetUp();
uint8_t LinkBit(bool eight, bool seven, bool six, bool five, bool fore, bool three, bool two, bool one);
void illumination();

Ticker flick;
BusOut LED(LED1, LED2, LED3, LED4);

DigitalOut YLED(p6);

DigitalIn CrossKey[4][2]={{p8, p30}, {p11, p29}, {p15, p28}, {p16, p27}};//p7, p12=reserve
DigitalIn SideKey[2][2]={{p17, p20}, {p18, p19}};
Pswitch Toggle(p5);

MultiSerial Xbee(p9, p10, write);//or p13, p14
Serial pc(USBTX, USBRX);

TextLCD lcd(p26, p25, p24, p23, p22, p21, TextLCD::LCD16x2); // rs, e, d4-d7

int main() {
    
   SetUp();
   
    while(1) {
        
        YLED=!Toggle.read();
        
        if(YLED&&SW) lcd.cls(), lcd.printf("Pause Mode\n"), SW=0;
        if((!YLED)&&(!SW)) lcd.cls(), lcd.printf("Run Mode\n"), SW=1;
        
        if(Toggle.read()){
            
            EXdata[0] = LinkBit(!CrossKey[YELLOW][LEFT], !CrossKey[RED][LEFT], !CrossKey[GREEN][LEFT], !CrossKey[BLUE][LEFT], 
                                !CrossKey[YELLOW][RIGHT], !CrossKey[RED][RIGHT], !CrossKey[GREEN][RIGHT], !CrossKey[BLUE][RIGHT]);
            EXdata[1] = LinkBit(0, 0, 0, 0, !SideKey[INDEX][LEFT], !SideKey[MIDDLE][LEFT], !SideKey[INDEX][RIGHT], !SideKey[MIDDLE][RIGHT]);
        }else{
            
            EXdata[0] = EXdata[1] = 0x00;
        }
        
    }
}

void SetUp(void){
    
    Xbee.write_data(EXdata, KEYCODE);
    
    if(!Toggle.read()) lcd.cls(), lcd.printf("Pause Mode\n"), SW=0;
    if(Toggle.read()) lcd.cls(), lcd.printf("Run Mode\n"), SW=1;
    
    CrossKey[NORTH][RIGHT].mode(PullUp);
    CrossKey[EAST][RIGHT].mode(PullUp);
    CrossKey[WEST][RIGHT].mode(PullUp);
    CrossKey[SOUTH][RIGHT].mode(PullUp);
    CrossKey[NORTH][LEFT].mode(PullUp);
    CrossKey[EAST][LEFT].mode(PullUp);
    CrossKey[WEST][LEFT].mode(PullUp);
    CrossKey[SOUTH][LEFT].mode(PullUp);
    
    SideKey[INDEX][RIGHT].mode(PullUp);
    SideKey[MIDDLE][RIGHT].mode(PullUp);
    SideKey[INDEX][LEFT].mode(PullUp);
    SideKey[MIDDLE][LEFT].mode(PullUp);
    
    flick.attach(illumination, INTERVAL);
}
uint8_t LinkBit(bool eight, bool seven, bool six, bool five, bool fore, bool three, bool two, bool one){//0と1を集めて整数を作る
    return 0x80*eight + 0x40*seven + 0x20*six + 0x10*five + 0x08*fore + 0x04*three + 0x02*two + 0x01*one;
}
void illumination(void){//literally
    count++;
    LED = count;
}