kashiko aoyama
/
r_test2
r_test2_2017_10_12_A
main.cpp@0:75f108e75c3f, 2017-10-12 (annotated)
- Committer:
- shobonwarrior
- Date:
- Thu Oct 12 07:58:10 2017 +0000
- Revision:
- 0:75f108e75c3f
r_test2_2017_10_12_A
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
shobonwarrior | 0:75f108e75c3f | 1 | #include "mbed.h" |
shobonwarrior | 0:75f108e75c3f | 2 | #include "ps3CTRLmbed.h" |
shobonwarrior | 0:75f108e75c3f | 3 | /* |
shobonwarrior | 0:75f108e75c3f | 4 | 上 下 1.0 |
shobonwarrior | 0:75f108e75c3f | 5 | 〇 一気に発射 |
shobonwarrior | 0:75f108e75c3f | 6 | R1 発射1 |
shobonwarrior | 0:75f108e75c3f | 7 | L1 発射2 |
shobonwarrior | 0:75f108e75c3f | 8 | R2 発射3 |
shobonwarrior | 0:75f108e75c3f | 9 | L2 発射4 |
shobonwarrior | 0:75f108e75c3f | 10 | △ 発射5 |
shobonwarrior | 0:75f108e75c3f | 11 | □ 発射6 |
shobonwarrior | 0:75f108e75c3f | 12 | */ |
shobonwarrior | 0:75f108e75c3f | 13 | DigitalOut TRD(p14); |
shobonwarrior | 0:75f108e75c3f | 14 | DigitalOut SQD(p15); |
shobonwarrior | 0:75f108e75c3f | 15 | DigitalOut UDD(p16); |
shobonwarrior | 0:75f108e75c3f | 16 | DigitalOut RD(p17); |
shobonwarrior | 0:75f108e75c3f | 17 | DigitalOut RRD(p18); |
shobonwarrior | 0:75f108e75c3f | 18 | DigitalOut LD(p19); |
shobonwarrior | 0:75f108e75c3f | 19 | DigitalOut LLD(p20); |
shobonwarrior | 0:75f108e75c3f | 20 | |
shobonwarrior | 0:75f108e75c3f | 21 | PwmOut UDP(p21); |
shobonwarrior | 0:75f108e75c3f | 22 | |
shobonwarrior | 0:75f108e75c3f | 23 | I2C i2c(p9,p10); |
shobonwarrior | 0:75f108e75c3f | 24 | |
shobonwarrior | 0:75f108e75c3f | 25 | int addr=0x00;//アドレスをいじるならここ |
shobonwarrior | 0:75f108e75c3f | 26 | int ack=0; |
shobonwarrior | 0:75f108e75c3f | 27 | double t1=0; |
shobonwarrior | 0:75f108e75c3f | 28 | |
shobonwarrior | 0:75f108e75c3f | 29 | int main() { |
shobonwarrior | 0:75f108e75c3f | 30 | char cmd[4]; |
shobonwarrior | 0:75f108e75c3f | 31 | PS3DefaultSet(); |
shobonwarrior | 0:75f108e75c3f | 32 | while(1) { |
shobonwarrior | 0:75f108e75c3f | 33 | CheckInputData(); |
shobonwarrior | 0:75f108e75c3f | 34 | for(int i=0;i<4;i++){ |
shobonwarrior | 0:75f108e75c3f | 35 | cmd[i]=(char)psdata[i+3]; |
shobonwarrior | 0:75f108e75c3f | 36 | } |
shobonwarrior | 0:75f108e75c3f | 37 | i2c.write(addr,cmd,4); |
shobonwarrior | 0:75f108e75c3f | 38 | |
shobonwarrior | 0:75f108e75c3f | 39 | /*上下*/ |
shobonwarrior | 0:75f108e75c3f | 40 | if(BTTRUE(UP)){/*上*/ |
shobonwarrior | 0:75f108e75c3f | 41 | t1+=0.2; |
shobonwarrior | 0:75f108e75c3f | 42 | if(t1>1.0){ |
shobonwarrior | 0:75f108e75c3f | 43 | t1=1.0; |
shobonwarrior | 0:75f108e75c3f | 44 | } |
shobonwarrior | 0:75f108e75c3f | 45 | UDD=0; |
shobonwarrior | 0:75f108e75c3f | 46 | UDP=t1; |
shobonwarrior | 0:75f108e75c3f | 47 | }else if(BTTRUE(DOWN)){/*下*/ |
shobonwarrior | 0:75f108e75c3f | 48 | t1+=0.2; |
shobonwarrior | 0:75f108e75c3f | 49 | if(t1>1.0){ |
shobonwarrior | 0:75f108e75c3f | 50 | t1=1.0; |
shobonwarrior | 0:75f108e75c3f | 51 | } |
shobonwarrior | 0:75f108e75c3f | 52 | UDD=1; |
shobonwarrior | 0:75f108e75c3f | 53 | UDP=t1; |
shobonwarrior | 0:75f108e75c3f | 54 | }else{ |
shobonwarrior | 0:75f108e75c3f | 55 | t1-=0.2; |
shobonwarrior | 0:75f108e75c3f | 56 | if(t1<0){ |
shobonwarrior | 0:75f108e75c3f | 57 | t1=0.0; |
shobonwarrior | 0:75f108e75c3f | 58 | } |
shobonwarrior | 0:75f108e75c3f | 59 | UDP=t1; |
shobonwarrior | 0:75f108e75c3f | 60 | } |
shobonwarrior | 0:75f108e75c3f | 61 | |
shobonwarrior | 0:75f108e75c3f | 62 | if(BTTRUE(CIRCLE)){ |
shobonwarrior | 0:75f108e75c3f | 63 | RD=0; |
shobonwarrior | 0:75f108e75c3f | 64 | LD=0; |
shobonwarrior | 0:75f108e75c3f | 65 | RRD=0; |
shobonwarrior | 0:75f108e75c3f | 66 | LLD=0; |
shobonwarrior | 0:75f108e75c3f | 67 | TRD=0; |
shobonwarrior | 0:75f108e75c3f | 68 | SQD=0; |
shobonwarrior | 0:75f108e75c3f | 69 | }else{ |
shobonwarrior | 0:75f108e75c3f | 70 | if(BTTRUE(SQUARE)){ |
shobonwarrior | 0:75f108e75c3f | 71 | SQD=0; |
shobonwarrior | 0:75f108e75c3f | 72 | }else{ |
shobonwarrior | 0:75f108e75c3f | 73 | SQD=1; |
shobonwarrior | 0:75f108e75c3f | 74 | } |
shobonwarrior | 0:75f108e75c3f | 75 | |
shobonwarrior | 0:75f108e75c3f | 76 | if(BTTRUE(TRIANGLE)){ |
shobonwarrior | 0:75f108e75c3f | 77 | TRD=0; |
shobonwarrior | 0:75f108e75c3f | 78 | }else{ |
shobonwarrior | 0:75f108e75c3f | 79 | TRD=1; |
shobonwarrior | 0:75f108e75c3f | 80 | } |
shobonwarrior | 0:75f108e75c3f | 81 | |
shobonwarrior | 0:75f108e75c3f | 82 | if(BTTRUE(L2)){ |
shobonwarrior | 0:75f108e75c3f | 83 | LLD=0; |
shobonwarrior | 0:75f108e75c3f | 84 | }else{ |
shobonwarrior | 0:75f108e75c3f | 85 | LLD=1; |
shobonwarrior | 0:75f108e75c3f | 86 | } |
shobonwarrior | 0:75f108e75c3f | 87 | |
shobonwarrior | 0:75f108e75c3f | 88 | if(BTTRUE(R2)){ |
shobonwarrior | 0:75f108e75c3f | 89 | RRD=0; |
shobonwarrior | 0:75f108e75c3f | 90 | }else{ |
shobonwarrior | 0:75f108e75c3f | 91 | RRD=1; |
shobonwarrior | 0:75f108e75c3f | 92 | } |
shobonwarrior | 0:75f108e75c3f | 93 | |
shobonwarrior | 0:75f108e75c3f | 94 | if(BTTRUE(R1)){ |
shobonwarrior | 0:75f108e75c3f | 95 | RD=0; |
shobonwarrior | 0:75f108e75c3f | 96 | }else{ |
shobonwarrior | 0:75f108e75c3f | 97 | RD=1; |
shobonwarrior | 0:75f108e75c3f | 98 | } |
shobonwarrior | 0:75f108e75c3f | 99 | |
shobonwarrior | 0:75f108e75c3f | 100 | if(BTTRUE(L1)){ |
shobonwarrior | 0:75f108e75c3f | 101 | LD=0; |
shobonwarrior | 0:75f108e75c3f | 102 | }else{ |
shobonwarrior | 0:75f108e75c3f | 103 | LD=1; |
shobonwarrior | 0:75f108e75c3f | 104 | } |
shobonwarrior | 0:75f108e75c3f | 105 | } |
shobonwarrior | 0:75f108e75c3f | 106 | |
shobonwarrior | 0:75f108e75c3f | 107 | } |
shobonwarrior | 0:75f108e75c3f | 108 | } |