手動bのほぼ全部

Dependents:   kobayashi_rei 2019BSyudo Bsyudo 2019Bsyudo

Committer:
THtakahiro702286
Date:
Fri Sep 13 03:01:12 2019 +0000
Revision:
6:3cb78320d4db
Parent:
4:eafd5a0c3351
Child:
8:8ff6db217a17
states

Who changed what in which revision?

UserRevisionLine numberNew contents of line
THtakahiro702286 0:8d012d469eb4 1 #ifndef STATES_H
THtakahiro702286 0:8d012d469eb4 2 #define STATES_H
THtakahiro702286 0:8d012d469eb4 3
THtakahiro702286 0:8d012d469eb4 4 #include "mbed.h"
THtakahiro702286 0:8d012d469eb4 5 #include "PID.h"
THtakahiro702286 0:8d012d469eb4 6 #include "pin_config.h"
THtakahiro702286 4:eafd5a0c3351 7 #include "PS3.h"
THtakahiro702286 0:8d012d469eb4 8 #include "R1370.h"
THtakahiro702286 4:eafd5a0c3351 9 #include "mechanism.h"
THtakahiro702286 6:3cb78320d4db 10 //#include <math.h>
THtakahiro702286 0:8d012d469eb4 11
THtakahiro702286 0:8d012d469eb4 12 #define front 0
THtakahiro702286 0:8d012d469eb4 13 #define right 90
THtakahiro702286 0:8d012d469eb4 14 #define back 180
THtakahiro702286 0:8d012d469eb4 15 #define left -90
THtakahiro702286 0:8d012d469eb4 16
THtakahiro702286 0:8d012d469eb4 17
THtakahiro702286 0:8d012d469eb4 18 class States
THtakahiro702286 0:8d012d469eb4 19 {
THtakahiro702286 0:8d012d469eb4 20 public:
THtakahiro702286 0:8d012d469eb4 21 States();
THtakahiro702286 0:8d012d469eb4 22 void tellAngle();
THtakahiro702286 0:8d012d469eb4 23 void tellPad();
THtakahiro702286 0:8d012d469eb4 24 void move();
THtakahiro702286 0:8d012d469eb4 25 private:
THtakahiro702286 6:3cb78320d4db 26
THtakahiro702286 1:38dd7564c15f 27 /*非常停止*/
THtakahiro702286 1:38dd7564c15f 28 DigitalOut emStop;
THtakahiro702286 1:38dd7564c15f 29
THtakahiro702286 0:8d012d469eb4 30 /*モーター系*/
THtakahiro702286 6:3cb78320d4db 31 // WheelUnit omni;
THtakahiro702286 0:8d012d469eb4 32 Serial serial;
THtakahiro702286 0:8d012d469eb4 33
THtakahiro702286 0:8d012d469eb4 34 /*角度制御*/
THtakahiro702286 0:8d012d469eb4 35 R1370 gyro;
THtakahiro702286 0:8d012d469eb4 36 PID anglePID;
THtakahiro702286 0:8d012d469eb4 37 float nowAngle;
THtakahiro702286 0:8d012d469eb4 38 int idealAngle;
THtakahiro702286 0:8d012d469eb4 39 float deviation;
THtakahiro702286 0:8d012d469eb4 40 float turnPower;
THtakahiro702286 0:8d012d469eb4 41 int state;
THtakahiro702286 4:eafd5a0c3351 42
THtakahiro702286 4:eafd5a0c3351 43 /*昇降 機構*/
THtakahiro702286 4:eafd5a0c3351 44 Mechanism mechanism;
THtakahiro702286 0:8d012d469eb4 45
THtakahiro702286 0:8d012d469eb4 46 /*コントローラ系*/
THtakahiro702286 4:eafd5a0c3351 47 PS3 pad;
THtakahiro702286 4:eafd5a0c3351 48 int stick[4],trigger[2];
THtakahiro702286 6:3cb78320d4db 49
THtakahiro702286 4:eafd5a0c3351 50 int b[12],b2[12],b3[12];
THtakahiro702286 6:3cb78320d4db 51 float norm[2];
THtakahiro702286 6:3cb78320d4db 52 //sint check;
THtakahiro702286 4:eafd5a0c3351 53
THtakahiro702286 0:8d012d469eb4 54 };
THtakahiro702286 0:8d012d469eb4 55 #endif