Changeset a0ef241 in pyramid


Ignore:
Timestamp:
10/24/13 17:06:52 (6 years ago)
Author:
Steve Castellotti <sc@…>
Branches:
master
Children:
124e727
Parents:
8dc32b3
Message:
  • complete communication of all Orbit setting varials added
File:
1 edited

Legend:

Unmodified
Added
Removed
  • firmware/Puzzlebox_Pyramid/Puzzlebox_Pyramid.ino

    r8dc32b3 ra0ef241  
    2828Original Author: Hao Zhang <hz@puzzlebox.info> 
    2929 
    30 Last Modified 2013-10-15 
     30Last Modified 2013-10-24 
    3131by Steve Castellotti <sc@puzzlebox.info> 
    3232 
     
    6060//G lobal variables for controlling Orbit helicopter 
    6161// variables start with "_" means global variable  
    62 char _throttle=0; //32~127, default 0 
    63 char _pitch=31; //0~63, default 31 
    64 char _yaw=78; //16~127, default 78 
     62#define DEFAULT_THROTTLE 0 
     63#define DEFAULT_YAW 78 
     64#define DEFAULT_PITCH 31 
     65char _throttle=DEFAULT_THROTTLE; //32~127, default 0 
     66char _yaw=DEFAULT_YAW; //16~127, default 78 
     67char _pitch=DEFAULT_PITCH; //0~63, default 31 
    6568char _channel='A'; 
    6669char _command; 
     
    8083 
    8184// Android ADK 
    82 //AndroidAccessory acc( 
    83 //      "puzzlebox", 
    84 //      "PuzzleboxPyramid", 
    85 //      "Puzzlebox Pyramid", 
    86 //      "1.2", 
    87 //      "http://pyramid.puzzlebox.info", 
    88 //      "0000000000000000" 
    89 //); 
    90  
    9185AndroidAccessory acc( 
    9286        "puzzlebox", 
    93         "TriggerRemote", 
    94         "DemoKit Arduino Board", 
    95         "1.0", 
    96         "http://www.android.com", 
    97         "0000000012345678" 
     87        "PuzzleboxPyramid", 
     88        "Puzzlebox Pyramid", 
     89        "1.2", 
     90        "http://pyramid.puzzlebox.info", 
     91        "0000000000000000" 
    9892); 
     93 
     94// AndroidAccessory acc( 
     95//      "puzzlebox", 
     96//      "TriggerRemote", 
     97//      "DemoKit Arduino Board", 
     98//      "1.0", 
     99//      "http://www.android.com", 
     100//      "0000000012345678" 
     101// ); 
    99102 
    100103byte msg[2]; 
     
    819822// ################################################################ 
    820823 
     824void setYaw() { 
     825 
     826        char inByte=0; 
     827        int a=0; 
     828        int b=0; 
     829        int c=0; 
     830        int newYaw=0; 
     831 
     832        while (Serial.available() == 0); 
     833        inByte = Serial.read() - '0'; 
     834        //Serial.println(inByte); 
     835        a = inByte; 
     836 
     837        while (Serial.available() == 0); 
     838        inByte = Serial.read() - '0'; 
     839        //Serial.println(inByte); 
     840        b = inByte; 
     841 
     842        while (Serial.available() == 0); 
     843        inByte = Serial.read() - '0'; 
     844        //Serial.println(inByte); 
     845        c = inByte; 
     846 
     847        newYaw = (a * 100) + (b * 10) + c; 
     848 
     849        if (newYaw < 0) 
     850                newYaw=0; 
     851 
     852        if (newYaw > 100) 
     853                newYaw=100; 
     854                 
     855        _yaw=newYaw; 
     856 
     857        Serial.print("_yaw="); 
     858        Serial.println(int(_yaw)); 
     859 
     860} // setYaw 
     861 
     862 
     863// ################################################################ 
     864 
    821865void setPitch() { 
    822866 
     
    856900 
    857901} // setPitch 
    858  
    859  
    860 // ################################################################ 
    861  
    862 //void setThrottle() { 
    863 // 
    864 //      char inByte=0; 
    865 //      int a=0; 
    866 //      int b=0; 
    867 //      int c=0; 
    868 //      int newThrottle=0; 
    869 // 
    870 //      while (Serial.available() == 0); 
    871 //      inByte = Serial.read() - '0'; 
    872 //      //Serial.println(inByte); 
    873 //      a = inByte; 
    874 // 
    875 //      while (Serial.available() == 0); 
    876 //      inByte = Serial.read() - '0'; 
    877 //      //Serial.println(inByte); 
    878 //      b = inByte; 
    879 // 
    880 //      while (Serial.available() == 0); 
    881 //      inByte = Serial.read() - '0'; 
    882 //      //Serial.println(inByte); 
    883 //      c = inByte; 
    884 // 
    885 //      newThrottle = (a * 100) + (b * 10) + c; 
    886 // 
    887 //      if (newThrottle < 0) 
    888 //              newThrottle=0; 
    889 // 
    890 //      if (newThrottle > 100) 
    891 //              newThrottle=100; 
    892 //               
    893 //      _throttle=newThrottle; 
    894 // 
    895 //      Serial.print("_throttle="); 
    896 //      Serial.println(int(_throttle)); 
    897 // 
    898 //} // setThrottle 
    899  
    900  
    901 // ################################################################ 
    902  
    903 void setYaw() { 
    904  
    905         char inByte=0; 
    906         int a=0; 
    907         int b=0; 
    908         int c=0; 
    909         int newYaw=0; 
    910  
    911         while (Serial.available() == 0); 
    912         inByte = Serial.read() - '0'; 
    913         //Serial.println(inByte); 
    914         a = inByte; 
    915  
    916         while (Serial.available() == 0); 
    917         inByte = Serial.read() - '0'; 
    918         //Serial.println(inByte); 
    919         b = inByte; 
    920  
    921         while (Serial.available() == 0); 
    922         inByte = Serial.read() - '0'; 
    923         //Serial.println(inByte); 
    924         c = inByte; 
    925  
    926         newYaw = (a * 100) + (b * 10) + c; 
    927  
    928         if (newYaw < 0) 
    929                 newYaw=0; 
    930  
    931         if (newYaw > 100) 
    932                 newYaw=100; 
    933                  
    934         _yaw=newYaw; 
    935  
    936         Serial.print("_yaw="); 
    937         Serial.println(int(_yaw)); 
    938  
    939 } // setYaw 
    940902 
    941903 
     
    12251187                         
    12261188                        if (msg[0] == 0x1) { 
    1227                                 // Reserved 
     1189                                Serial.println("0x1"); 
     1190                                eegSignal = (int)msg[1]; 
     1191                                Serial.println(eegSignal); 
    12281192                        } 
     1193                         
    12291194                        else if(msg[0] == 0x2) { 
    1230                                 // Reserved 
     1195                                Serial.println("0x2"); 
     1196                                eegAttention = (int)msg[1]; 
     1197                                Serial.println(eegAttention); 
    12311198                        } 
     1199                         
    12321200                        else if (msg[0] == 0x3) { 
    1233                                 // Reserved 
     1201                                Serial.println("0x3"); 
     1202                                eegMeditation = (int)msg[1]; 
     1203                                Serial.println(eegMeditation); 
    12341204                        } 
    12351205                         
    1236                         // EEG Signal 
    12371206                        else if (msg[0] == 0x4) { 
    1238                                 eegSignal = 0; 
    1239                                 if (msg[1] == 0x1) { 
    1240                                         eegSignal = 10; 
    1241                                 } else if (msg[1] == 0x2) { 
    1242                                         eegSignal = 20; 
    1243                                 } else if (msg[1] == 0x3) { 
    1244                                         eegSignal = 30; 
    1245                                 } else if (msg[1] == 0x4) { 
    1246                                         eegSignal = 40; 
    1247                                 } else if (msg[1] == 0x5) { 
    1248                                         eegSignal = 50; 
    1249                                 } else if (msg[1] == 0x6) { 
    1250                                         eegSignal = 60; 
    1251                                 } else if (msg[1] == 0x7) { 
    1252                                         eegSignal = 70; 
    1253                                 } else if (msg[1] == 0x8) { 
    1254                                         eegSignal = 80; 
    1255                                 } else if (msg[1] == 0x9) { 
    1256                                         eegSignal = 90; 
    1257                                 } else { 
    1258                                         eegSignal = 100; 
    1259                                 } 
     1207                                Serial.println("0x4"); 
     1208                                eegPower = (int)msg[1]; 
     1209                                Serial.println(eegPower); 
    12601210                        } 
    12611211                         
    1262                          
    1263                         // EEG Attention 
    1264                         else if (msg[0] == 0x5) { 
    1265                                 eegAttention = 0; 
    1266                                 if (msg[1] == 0x1) { 
    1267                                         eegAttention = 10; 
    1268                                 } else if (msg[1] == 0x2) { 
    1269                                         eegAttention = 20; 
    1270                                 } else if (msg[1] == 0x3) { 
    1271                                         eegAttention = 30; 
    1272                                 } else if (msg[1] == 0x4) { 
    1273                                         eegAttention = 40; 
    1274                                 } else if (msg[1] == 0x5) { 
    1275                                         eegAttention = 50; 
    1276                                 } else if (msg[1] == 0x6) { 
    1277                                         eegAttention = 60; 
    1278                                 } else if (msg[1] == 0x7) { 
    1279                                         eegAttention = 70; 
    1280                                 } else if (msg[1] == 0x8) { 
    1281                                         eegAttention = 80; 
    1282                                 } else if (msg[1] == 0x9) { 
    1283                                         eegAttention = 90; 
    1284                                 } else { 
    1285                                         eegAttention = 100; 
    1286                                 } 
     1212                        else if(msg[0] == 0x5) { 
     1213                                Serial.println("0x5"); 
     1214                                _throttle = (int)msg[1]; 
     1215                                Serial.println(_throttle); 
    12871216                        } 
    12881217                         
    1289                          
    1290                         // EEG Meditation 
    12911218                        else if (msg[0] == 0x6) { 
    1292                                 eegMeditation = 0; 
    1293                                 if (msg[1] == 0x1) { 
    1294                                         eegMeditation = 10; 
    1295                                 } else if (msg[1] == 0x2) { 
    1296                                         eegMeditation = 20; 
    1297                                 } else if (msg[1] == 0x3) { 
    1298                                         eegMeditation = 30; 
    1299                                 } else if (msg[1] == 0x4) { 
    1300                                         eegMeditation = 40; 
    1301                                 } else if (msg[1] == 0x5) { 
    1302                                         eegMeditation = 50; 
    1303                                 } else if (msg[1] == 0x6) { 
    1304                                         eegMeditation = 60; 
    1305                                 } else if (msg[1] == 0x7) { 
    1306                                         eegMeditation = 70; 
    1307                                 } else if (msg[1] == 0x8) { 
    1308                                         eegMeditation = 80; 
    1309                                 } else if (msg[1] == 0x9) { 
    1310                                         eegMeditation = 90; 
    1311                                 } else { 
    1312                                         eegMeditation = 100; 
    1313                                 } 
     1219                                Serial.println("0x6"); 
     1220                                _yaw = (int)msg[1]; 
     1221                                Serial.println(_yaw); 
    13141222                        } 
    13151223                         
    1316                          
    1317                         // EEG Power 
    1318 //                      else if (msg[0] == 0x7) { 
    1319 //                              Serial.println("0x7"); 
    1320 //                              eegPower = 0; 
    1321 //                              if (msg[1] == 0x1) { 
    1322 //                                      eegPower = 10; 
    1323 //                              } else if (msg[1] == 0x2) { 
    1324 //                                      eegPower = 20; 
    1325 //                              } else if (msg[1] == 0x3) { 
    1326 //                                      eegPower = 30; 
    1327 //                              } else if (msg[1] == 0x4) { 
    1328 //                                      eegPower = 40; 
    1329 //                              } else if (msg[1] == 0x5) { 
    1330 //                                      eegPower = 50; 
    1331 //                              } else if (msg[1] == 0x6) { 
    1332 //                                      eegPower = 60; 
    1333 //                              } else if (msg[1] == 0x7) { 
    1334 //                                      eegPower = 70; 
    1335 //                              } else if (msg[1] == 0x8) { 
    1336 //                                      eegPower = 80; 
    1337 //                              } else if (msg[1] == 0x9) { 
    1338 //                                      eegPower = 90; 
    1339 //                              } else { 
    1340 //                                      eegPower = 100; 
    1341 //                                      Serial.println("0xa"); 
    1342 //                              } 
    1343 //                      } 
    1344  
    1345  
    13461224                        else if (msg[0] == 0x7) { 
    13471225                                Serial.println("0x7"); 
    1348 //                              eegPower = 0; 
    1349 //                              if (msg[1] == 0x1) { 
    1350                                         eegPower = (int)msg[1]; 
    1351                                         Serial.print("eegPower "); 
    1352                                         Serial.println(eegPower); 
    1353 //                              } 
     1226                                _pitch = (int)msg[1]; 
     1227                                Serial.println(_pitch); 
    13541228                        } 
    1355  
    1356                          
    1357                          
    1358                         // Orbit Throttle 
     1229                         
     1230                         
     1231                        // Orbit Hover 
    13591232                        else if (msg[0] == 0x8) { 
    13601233                                 
     
    13641237                                        setColorWheel(255,255,255); // White 
    13651238                                        _throttle = _throttle_hover; 
     1239                                        _yaw = DEFAULT_YAW; 
     1240                                        _pitch = DEFAULT_PITCH; 
    13661241//                                      Serial.println(" (msg[1] == 0x1) "); 
    13671242                                } 
     
    13691244                                        setColorWheel(255,0,0); // Red 
    13701245//                                      Serial.println(" (msg[1] == 0x0) "); 
    1371                                         _throttle = 0; 
     1246//                                      _throttle = 0; 
     1247                                        _throttle = DEFAULT_THROTTLE; 
     1248                                        _yaw = DEFAULT_YAW; 
     1249                                        _pitch = DEFAULT_PITCH; 
    13721250                                } 
    13731251                                 
     
    13931271 
    13941272 
     1273 
     1274 
Note: See TracChangeset for help on using the changeset viewer.