main.cpp

00001 //PS4コントローラーにしわき拡張版
00002 #include "FEP_TX22.h"
00003 #include "SerialArduino.h"
00004 #include "pinconfig.h"
00005 #define SWNUM 8
00006 #define DATANUM 128
00007 
00008 SerialArduino mini(TXino, RXino, 115200);
00009 
00010 //FEP,PCの宣言
00011 FEP_TX22 FEP_TX22(fepTX, fepRX, fepad);
00012 Serial pc(USBTX, USBRX, 115200);
00013 
00014 //拡張部の宣言
00015 AnalogIn volume1(vol1);
00016 AnalogIn volume2(vol2);
00017 AnalogIn volume3(vol3);
00018 DigitalIn stop(em_stop);
00019 DigitalIn toggle1(tgl1);
00020 DigitalIn toggle2(tgl2);
00021 DigitalIn toggle3(tgl3);
00022 
00023 int main()
00024 {
00025     uint8_t data[DATANUM];
00026     while(1)
00027     {
00028         mini.getState(data);
00029         data[9] = (int)(volume1*255);   //左
00030         data[10] = (int)(volume2*255);  //中
00031         data[11] = (int)(volume3*255);  //右
00032         data[12] = stop;                //上
00033         data[13] = toggle1;             //左
00034         data[14] = toggle2;             //中
00035         data[15] = toggle3;             //右
00036         //PC表示部分
00037         pc.printf("%3d | sw:%3d %3d | stick:%3d %3d %3d %3d | trig:%3d %3d  | vol:%3d %3d %3d | tgl:%3d %3d %3d | %3d\r\n"
00038         , data[12], data[0], data[1], data[2], data[3], data[4], data[5], data[6], data[7], data[9], data[10], data[11], data[13], data[14], data[15], data[8]);
00039         
00040         FEP_TX22.SendData(data, 16);
00041     }
00042 }