2015_robocon_bteam / Mbed 2 deprecated 2015robot_main

Important changes to repositories hosted on mbed.com

Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.

To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.

It is also possible to export all your personal repositories from the account settings page.

Dependencies:   PID QEI mbed

Fork of 2015robot_main by Naoto Deguchi

manualMode.h@107:579bb1ab67d9, 2015-10-19 (annotated)

Committer:
DeguNaoto
Date:
Mon Oct 19 08:29:58 2015 +0000
Revision:
107:579bb1ab67d9
Parent:
105:0be5d5d64782
Child:
108:7eb434cfcbd7
20151019 17:26 ???

Who changed what in which revision?

UserRevisionLine numberNew contents of line
DeguNaoto 22:3996c3f41922 1 #ifndef MANUALMODE_H
DeguNaoto 22:3996c3f41922 2 #define MANUALMODE_H
DeguNaoto 22:3996c3f41922 3
DeguNaoto 57:3fbd487e055e 4 #ifdef IM920
DeguNaoto 52:d9e1629da852 5 void manualMoveIM920()
DeguNaoto 31:74e77ef0831c 6 {
DeguNaoto 87:6b6b6611d33f 7 if(Y<2) {
DeguNaoto 31:74e77ef0831c 8 Move_l(-0.4);
DeguNaoto 31:74e77ef0831c 9 Move_r(0.4);
DeguNaoto 51:cb430192b28b 10 }
DeguNaoto 87:6b6b6611d33f 11 else if(Y>6) {
DeguNaoto 31:74e77ef0831c 12 Move_l(0.4);
DeguNaoto 31:74e77ef0831c 13 Move_r(-0.4);
DeguNaoto 51:cb430192b28b 14 }
DeguNaoto 51:cb430192b28b 15 else {
DeguNaoto 83:e1638c58e1f1 16 if(X<2) {
DeguNaoto 79:7f86e18f40ef 17 Move_l(0.6);
DeguNaoto 79:7f86e18f40ef 18 Move_r(0.6);
DeguNaoto 83:e1638c58e1f1 19 } else if(X>6) {
DeguNaoto 83:e1638c58e1f1 20 Move_l(-0.61);
DeguNaoto 79:7f86e18f40ef 21 Move_r(-0.6);
DeguNaoto 31:74e77ef0831c 22 } else {
DeguNaoto 24:271da6144a02 23 Move_l(0.0);
DeguNaoto 24:271da6144a02 24 Move_r(0.0);
DeguNaoto 24:271da6144a02 25 }
DeguNaoto 52:d9e1629da852 26 }
DeguNaoto 23:5c56747bcc43 27 }
DeguNaoto 52:d9e1629da852 28 void manualIM920()
DeguNaoto 31:74e77ef0831c 29 {
DeguNaoto 52:d9e1629da852 30 if(b==7){ /*mode change*/
DeguNaoto 52:d9e1629da852 31 if(edge7){
DeguNaoto 52:d9e1629da852 32 edge7=0;
DeguNaoto 52:d9e1629da852 33 autoflag=1;
DeguNaoto 52:d9e1629da852 34 Indicator4=1;
DeguNaoto 52:d9e1629da852 35 IndicatorAuto=0;
DeguNaoto 101:b67d33e56b66 36 Move_l(0.0);
DeguNaoto 101:b67d33e56b66 37 Move_r(0.0);
DeguNaoto 107:579bb1ab67d9 38 resetState();
DeguNaoto 87:6b6b6611d33f 39 flaga=0;
DeguNaoto 101:b67d33e56b66 40 step=114;
DeguNaoto 101:b67d33e56b66 41 CStep=114;
DeguNaoto 101:b67d33e56b66 42 spcount=speed;
DeguNaoto 52:d9e1629da852 43 }
DeguNaoto 52:d9e1629da852 44 }
DeguNaoto 87:6b6b6611d33f 45 else if(b==5){
DeguNaoto 87:6b6b6611d33f 46 if(edge5){
DeguNaoto 87:6b6b6611d33f 47 edge5=0;
unicore32 93:9cacc1763463 48 interruptSwingSpeed.attach(&countSwingSpeed, 0.05);
DeguNaoto 90:9fe39ebe721f 49 // targSwingRadVelocity = swingspeed;
unicore32 91:83c2e0381384 50 /*for(float i=0.0;i<0.6;i+=0.01){
DeguNaoto 87:6b6b6611d33f 51 Motor_swing=i;
DeguNaoto 87:6b6b6611d33f 52 wait(0.05);
DeguNaoto 87:6b6b6611d33f 53 }
unicore32 91:83c2e0381384 54 Motor_swing = 0.6;*/
DeguNaoto 60:4a75f3f3a934 55 }
DeguNaoto 52:d9e1629da852 56 }
DeguNaoto 87:6b6b6611d33f 57 else if(b==8){
DeguNaoto 87:6b6b6611d33f 58 if(edge8){
DeguNaoto 87:6b6b6611d33f 59 edge8=0;
DeguNaoto 57:3fbd487e055e 60 enableShoot=1;
DeguNaoto 52:d9e1629da852 61 }
DeguNaoto 83:e1638c58e1f1 62 }
DeguNaoto 87:6b6b6611d33f 63 else if(b==9){
DeguNaoto 101:b67d33e56b66 64 interruptSwingSpeed.detach();
unicore32 91:83c2e0381384 65 targSwingRadVelocity = 0.0;
unicore32 91:83c2e0381384 66 contSwing.reset();
unicore32 91:83c2e0381384 67 // Motor_swing = 0.0;
DeguNaoto 87:6b6b6611d33f 68 }
DeguNaoto 74:5dd06d211b12 69 else if(b==1){ /*L down*/
DeguNaoto 74:5dd06d211b12 70 if(edge1){
DeguNaoto 74:5dd06d211b12 71 edge1=0;
DeguNaoto 74:5dd06d211b12 72 if(stateL!=1) stateL--;
DeguNaoto 74:5dd06d211b12 73 sendData(4,stateL);
DeguNaoto 74:5dd06d211b12 74 }
DeguNaoto 74:5dd06d211b12 75 }
DeguNaoto 74:5dd06d211b12 76 else if(b==2){ /*L up*/
DeguNaoto 74:5dd06d211b12 77 if(edge2){
DeguNaoto 74:5dd06d211b12 78 edge2=0;
unicore32 78:abb760e0a935 79 if(stateL!=92) stateL++;
DeguNaoto 74:5dd06d211b12 80 sendData(4,stateL);
DeguNaoto 74:5dd06d211b12 81 }
DeguNaoto 52:d9e1629da852 82 }
DeguNaoto 74:5dd06d211b12 83 else if(b==3){ /*R down*/
DeguNaoto 74:5dd06d211b12 84 if(edge3){
DeguNaoto 74:5dd06d211b12 85 edge3=0;
DeguNaoto 74:5dd06d211b12 86 if(stateR!=1) stateR--;
DeguNaoto 74:5dd06d211b12 87 sendData(5,stateR);
DeguNaoto 74:5dd06d211b12 88 }
DeguNaoto 74:5dd06d211b12 89 }
DeguNaoto 74:5dd06d211b12 90 else if(b==4){ /*R up*/
DeguNaoto 74:5dd06d211b12 91 if(edge4){
DeguNaoto 74:5dd06d211b12 92 edge4=0;
unicore32 78:abb760e0a935 93 if(stateR!=92) stateR++;
DeguNaoto 74:5dd06d211b12 94 sendData(5,stateR);
DeguNaoto 74:5dd06d211b12 95 }
DeguNaoto 52:d9e1629da852 96 }
DeguNaoto 105:0be5d5d64782 97 if(deadflag){
DeguNaoto 105:0be5d5d64782 98 interruptSwingSpeed.detach();
DeguNaoto 105:0be5d5d64782 99 targSwingRadVelocity = 0.0;
DeguNaoto 105:0be5d5d64782 100 contSwing.reset();
DeguNaoto 105:0be5d5d64782 101 }
DeguNaoto 52:d9e1629da852 102 if(b!=7) edge7=1;
DeguNaoto 52:d9e1629da852 103 if(b!=1) edge1=1;
DeguNaoto 52:d9e1629da852 104 if(b!=2) edge2=1;
DeguNaoto 52:d9e1629da852 105 if(b!=3) edge3=1;
DeguNaoto 52:d9e1629da852 106 if(b!=4) edge4=1;
DeguNaoto 52:d9e1629da852 107 if(b!=5) edge5=1;
DeguNaoto 83:e1638c58e1f1 108 if(b!=8) edge8=1;
DeguNaoto 83:e1638c58e1f1 109 if(b!=9) edge9=1;
DeguNaoto 57:3fbd487e055e 110 }
DeguNaoto 57:3fbd487e055e 111 #else
DeguNaoto 57:3fbd487e055e 112 void manualMovePS3()
DeguNaoto 57:3fbd487e055e 113 {
DeguNaoto 66:14df82661dfa 114 if(analog_ly>50) {
DeguNaoto 57:3fbd487e055e 115 Move_l(-0.4);
DeguNaoto 57:3fbd487e055e 116 Move_r(0.4);
DeguNaoto 57:3fbd487e055e 117 }
DeguNaoto 66:14df82661dfa 118 else if(analog_ly<-50) {
DeguNaoto 57:3fbd487e055e 119 Move_l(0.4);
DeguNaoto 57:3fbd487e055e 120 Move_r(-0.4);
DeguNaoto 48:64d005c70df2 121 }
DeguNaoto 57:3fbd487e055e 122 else {
DeguNaoto 66:14df82661dfa 123 if(analog_lx>50) {
DeguNaoto 79:7f86e18f40ef 124 Move_l(0.6);
DeguNaoto 79:7f86e18f40ef 125 Move_r(0.6);
DeguNaoto 66:14df82661dfa 126 } else if(analog_lx<-50) {
DeguNaoto 79:7f86e18f40ef 127 Move_l(-0.6);
DeguNaoto 79:7f86e18f40ef 128 Move_r(-0.6);
DeguNaoto 57:3fbd487e055e 129 } else {
DeguNaoto 57:3fbd487e055e 130 Move_l(0.0);
DeguNaoto 57:3fbd487e055e 131 Move_r(0.0);
DeguNaoto 57:3fbd487e055e 132 }
DeguNaoto 57:3fbd487e055e 133 }
DeguNaoto 57:3fbd487e055e 134 }
DeguNaoto 57:3fbd487e055e 135 void manualPS3(){
DeguNaoto 57:3fbd487e055e 136 if(circle){ /*mode change*/
DeguNaoto 57:3fbd487e055e 137 if(edge_circle){
DeguNaoto 57:3fbd487e055e 138 edge_circle=0;
DeguNaoto 57:3fbd487e055e 139 autoflag=1;
DeguNaoto 57:3fbd487e055e 140 Indicator4=1;
DeguNaoto 57:3fbd487e055e 141 IndicatorAuto=0;
DeguNaoto 83:e1638c58e1f1 142 resetState();
DeguNaoto 57:3fbd487e055e 143 }
DeguNaoto 57:3fbd487e055e 144 }
DeguNaoto 57:3fbd487e055e 145 else if(triangle){
DeguNaoto 84:919a335ac81e 146 if(edge_triangle){
DeguNaoto 84:919a335ac81e 147 edge_triangle=0;
DeguNaoto 85:dd18a2d79956 148 /*if(targSwingRadVelocity == 0.0) targSwingRadVelocity = swingspeed;
DeguNaoto 84:919a335ac81e 149 else {
DeguNaoto 84:919a335ac81e 150 targSwingRadVelocity = 0.0;
DeguNaoto 84:919a335ac81e 151 contSwing.reset();
DeguNaoto 85:dd18a2d79956 152 }*/
DeguNaoto 85:dd18a2d79956 153 targSwingRadVelocity = swingspeed;
DeguNaoto 84:919a335ac81e 154 }
DeguNaoto 66:14df82661dfa 155 /*for(float i=0.0;i<1.0;i+=0.01){
DeguNaoto 60:4a75f3f3a934 156 Motor_swing=i;
DeguNaoto 62:02a44f5bc51e 157 wait(0.02);
DeguNaoto 60:4a75f3f3a934 158 }
DeguNaoto 66:14df82661dfa 159 Motor_swing = 1.0;*/
DeguNaoto 57:3fbd487e055e 160 }
DeguNaoto 85:dd18a2d79956 161 else if(cross){
DeguNaoto 85:dd18a2d79956 162 targSwingRadVelocity = 0.0;
DeguNaoto 85:dd18a2d79956 163 contSwing.reset();
DeguNaoto 85:dd18a2d79956 164 }
DeguNaoto 57:3fbd487e055e 165 else if(square){
DeguNaoto 57:3fbd487e055e 166 if(edge_square){
DeguNaoto 46:30776358bd42 167 edge_square=0;
DeguNaoto 57:3fbd487e055e 168 enableShoot=1;
DeguNaoto 29:03bb1ddbe456 169 }
DeguNaoto 49:9276fda93084 170 }
DeguNaoto 74:5dd06d211b12 171 else if(left){
DeguNaoto 57:3fbd487e055e 172 sendData(1,5);
DeguNaoto 57:3fbd487e055e 173 }
DeguNaoto 74:5dd06d211b12 174 else if(right){
DeguNaoto 57:3fbd487e055e 175 sendData(1,4);
DeguNaoto 57:3fbd487e055e 176 }
DeguNaoto 74:5dd06d211b12 177 else if(l1){ /*L up*/
DeguNaoto 74:5dd06d211b12 178 if(edge_l1){
DeguNaoto 74:5dd06d211b12 179 edge_l1=0;
DeguNaoto 74:5dd06d211b12 180 if(stateL!=1) stateL--;
DeguNaoto 74:5dd06d211b12 181 sendData(4,stateL);
DeguNaoto 74:5dd06d211b12 182 }
DeguNaoto 74:5dd06d211b12 183 }
DeguNaoto 74:5dd06d211b12 184 else if(l2){ /*L down*/
DeguNaoto 74:5dd06d211b12 185 if(edge_l2){
DeguNaoto 74:5dd06d211b12 186 edge_l2=0;
DeguNaoto 84:919a335ac81e 187 if(stateL!=MAX_VALUE) stateL++;
DeguNaoto 74:5dd06d211b12 188 sendData(4,stateL);
DeguNaoto 74:5dd06d211b12 189 }
DeguNaoto 74:5dd06d211b12 190 }
DeguNaoto 74:5dd06d211b12 191 else if(r1){ /*R up*/
DeguNaoto 74:5dd06d211b12 192 if(edge_r1){
DeguNaoto 74:5dd06d211b12 193 edge_r1=0;
DeguNaoto 74:5dd06d211b12 194 if(stateR!=1) stateR--;
DeguNaoto 74:5dd06d211b12 195 sendData(5,stateR);
DeguNaoto 74:5dd06d211b12 196 }
DeguNaoto 74:5dd06d211b12 197 }
DeguNaoto 74:5dd06d211b12 198 else if(r2){ /*R down*/
DeguNaoto 74:5dd06d211b12 199 if(edge_r2){
DeguNaoto 74:5dd06d211b12 200 edge_r2=0;
DeguNaoto 84:919a335ac81e 201 if(stateR!=MAX_VALUE) stateR++;
DeguNaoto 74:5dd06d211b12 202 sendData(5,stateR);
DeguNaoto 74:5dd06d211b12 203 }
DeguNaoto 74:5dd06d211b12 204 }
DeguNaoto 29:03bb1ddbe456 205 }
DeguNaoto 57:3fbd487e055e 206 #endif
DeguNaoto 22:3996c3f41922 207 #endif /*manualMode.h*/