CanSat2015aizu / CanSat_aoki

2015.07.23

Dependencies:   VNH5019

Dependents:   Cansat_program2

Fork of CanSat by CanSat2015aizu

cansat.cpp@4:8713fff9e20d, 2015-08-06 (annotated)

Committer:
s1200058
Date:
Thu Aug 06 17:06:08 2015 +0000
Revision:
4:8713fff9e20d
Parent:
2:0f76226be922
Child:
5:534a54a44b22
test

Who changed what in which revision?

UserRevisionLine numberNew contents of line
kityann 2:0f76226be922 1 #include "cansat.h"
kityann 2:0f76226be922 2
kityann 2:0f76226be922 3
kityann 2:0f76226be922 4 //////////////////////////////
kityann 2:0f76226be922 5 // Init //
kityann 2:0f76226be922 6 //////////////////////////////
kityann 2:0f76226be922 7 CanSat::CanSat(VNH5019 agzSheild):_agzSheild(agzSheild){
kityann 2:0f76226be922 8
kityann 2:0f76226be922 9 }
kityann 2:0f76226be922 10
kityann 2:0f76226be922 11
kityann 2:0f76226be922 12
kityann 2:0f76226be922 13 void CanSat::control_Motor(int flag,int speed){
kityann 2:0f76226be922 14
kityann 2:0f76226be922 15 if(flag == 0){
kityann 2:0f76226be922 16 _agzSheild.changeSpeed(1, speed, 1, speed); //straight
kityann 2:0f76226be922 17 motor_command = 'f';
kityann 2:0f76226be922 18 }
kityann 2:0f76226be922 19 if(flag == 1){
kityann 2:0f76226be922 20 _agzSheild.changeSpeed(0, speed, 0, speed);
kityann 2:0f76226be922 21 motor_command = 's';
kityann 2:0f76226be922 22 }
kityann 2:0f76226be922 23 if(flag == 2){
kityann 2:0f76226be922 24 _agzSheild.changeSpeed(1, speed, 2, speed); //Turn Right
kityann 2:0f76226be922 25 motor_command = 'r';
kityann 2:0f76226be922 26 }
kityann 2:0f76226be922 27 if(flag == 3){
kityann 2:0f76226be922 28 _agzSheild.changeSpeed(2, speed, 1, speed); //Turn Right
kityann 2:0f76226be922 29 motor_command = 'l';
kityann 2:0f76226be922 30 }
kityann 2:0f76226be922 31 if(flag == 4){
kityann 2:0f76226be922 32 _agzSheild.changeSpeed(2, speed, 2, speed);
kityann 2:0f76226be922 33 motor_command = 'b';
kityann 2:0f76226be922 34 }
kityann 2:0f76226be922 35 }
kityann 2:0f76226be922 36
kityann 2:0f76226be922 37
kityann 2:0f76226be922 38 //////////////////////////////
kityann 2:0f76226be922 39 // Get //
kityann 2:0f76226be922 40 //////////////////////////////
kityann 2:0f76226be922 41 double CanSat::get_robot_x(){
kityann 2:0f76226be922 42 return robot_x;
kityann 2:0f76226be922 43 }
kityann 2:0f76226be922 44 double CanSat::get_robot_y(){
kityann 2:0f76226be922 45 return robot_y;
kityann 2:0f76226be922 46 }
kityann 2:0f76226be922 47 double CanSat::get_robotKalman_x(){
kityann 2:0f76226be922 48 return robotK_x;
kityann 2:0f76226be922 49 }
kityann 2:0f76226be922 50 double CanSat::get_robotKalman_y(){
kityann 2:0f76226be922 51 return robotK_y;
kityann 2:0f76226be922 52 }
s1200058 4:8713fff9e20d 53 double CanSat::get_compass_z(){
s1200058 4:8713fff9e20d 54 return compass_z;
s1200058 4:8713fff9e20d 55 }
s1200058 4:8713fff9e20d 56 double CanSat::get_target_distance(){
s1200058 4:8713fff9e20d 57 return target_distance;
s1200058 4:8713fff9e20d 58 }
s1200058 4:8713fff9e20d 59 double CanSat::get_target_x(){
s1200058 4:8713fff9e20d 60 return target_x;
s1200058 4:8713fff9e20d 61 }
s1200058 4:8713fff9e20d 62 double CanSat::get_target_y(){
s1200058 4:8713fff9e20d 63 return target_y;
s1200058 4:8713fff9e20d 64 }
s1200058 4:8713fff9e20d 65 int CanSat::get_speed(){
s1200058 4:8713fff9e20d 66 return speed;
s1200058 4:8713fff9e20d 67 }
s1200058 4:8713fff9e20d 68 int CanSat::get_robot_angle(){
s1200058 4:8713fff9e20d 69 return robot_angle;
s1200058 4:8713fff9e20d 70 }
s1200058 4:8713fff9e20d 71 int CanSat::get_target_angle(){
s1200058 4:8713fff9e20d 72 return target_angle;
s1200058 4:8713fff9e20d 73 }
s1200058 4:8713fff9e20d 74 double CanSat::get_pressure(){
s1200058 4:8713fff9e20d 75 return pressure;
s1200058 4:8713fff9e20d 76 }
s1200058 4:8713fff9e20d 77 double CanSat::get_temperature(){
s1200058 4:8713fff9e20d 78 return temperature;
s1200058 4:8713fff9e20d 79 }
s1200058 4:8713fff9e20d 80 double CanSat::get_humidity(){
s1200058 4:8713fff9e20d 81 return humidity;
s1200058 4:8713fff9e20d 82 }
kityann 2:0f76226be922 83 //////////////////////////////
kityann 2:0f76226be922 84 // Set //
kityann 2:0f76226be922 85 //////////////////////////////
kityann 2:0f76226be922 86 void CanSat::set_robot_x(double x){
kityann 2:0f76226be922 87 robot_x = x;
kityann 2:0f76226be922 88 }
kityann 2:0f76226be922 89 void CanSat::set_robot_y(double y){
kityann 2:0f76226be922 90 robot_y = y;
kityann 2:0f76226be922 91 }
kityann 2:0f76226be922 92
kityann 2:0f76226be922 93 void CanSat::set_robotKalman_x(double cur_x){
kityann 2:0f76226be922 94 robotK_x = cur_x;
kityann 2:0f76226be922 95 }
kityann 2:0f76226be922 96 void CanSat::set_robotKalman_y(double cur_y){
kityann 2:0f76226be922 97 robotK_y = cur_y;
kityann 2:0f76226be922 98 }
kityann 2:0f76226be922 99 void CanSat::set_gyro(double x, double y, double z){
kityann 2:0f76226be922 100 CanSat::gyro_x = x;
kityann 2:0f76226be922 101 CanSat::gyro_y = y;
kityann 2:0f76226be922 102 CanSat::gyro_z = z;
kityann 2:0f76226be922 103 }
kityann 2:0f76226be922 104 void CanSat::set_compass(double x, double y, double z){
kityann 2:0f76226be922 105 CanSat::compass_x = x;
kityann 2:0f76226be922 106 CanSat::compass_y = y;
kityann 2:0f76226be922 107 CanSat::compass_z = z;
kityann 2:0f76226be922 108 }
kityann 2:0f76226be922 109 void CanSat::set_pressure(double p){
kityann 2:0f76226be922 110 CanSat::pressure = p;
kityann 2:0f76226be922 111 }
kityann 2:0f76226be922 112 void CanSat::set_temperature(double t){
kityann 2:0f76226be922 113 CanSat::temperature = t;
kityann 2:0f76226be922 114 }
kityann 2:0f76226be922 115 void CanSat::set_humidity(double h){
kityann 2:0f76226be922 116 CanSat::humidity = h;
kityann 2:0f76226be922 117 }
kityann 2:0f76226be922 118 void CanSat::set_acceleration(double x, double y, double z){
kityann 2:0f76226be922 119 CanSat::acceleration_x = x;
kityann 2:0f76226be922 120 CanSat::acceleration_y = y;
kityann 2:0f76226be922 121 CanSat::acceleration_z = z;
s1200058 4:8713fff9e20d 122 }
s1200058 4:8713fff9e20d 123 void CanSat::set_target_distance(double distance){
s1200058 4:8713fff9e20d 124 CanSat::target_distance = distance;
s1200058 4:8713fff9e20d 125 }
s1200058 4:8713fff9e20d 126 void CanSat::set_speed(int new_speed){
s1200058 4:8713fff9e20d 127 CanSat::speed = new_speed;
s1200058 4:8713fff9e20d 128 }
s1200058 4:8713fff9e20d 129 void CanSat::set_robot_angle(int new_robot_angle){
s1200058 4:8713fff9e20d 130 CanSat::robot_angle = new_robot_angle;
s1200058 4:8713fff9e20d 131 }
s1200058 4:8713fff9e20d 132 void CanSat::set_target_angle(int new_target_angle){
s1200058 4:8713fff9e20d 133 CanSat::target_angle = new_target_angle;
kityann 2:0f76226be922 134 }