r_test2_2017_10_12_A

Dependencies:   mbed

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?

UserRevisionLine numberNew 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 }