| 428 | } |
| 429 | |
| 430 | void printf_param() |
| 431 | { |
| 432 | cout <<">>>>>>>>>>>>>>>>>>>>>>>> px4_pos_controller Parameter <<<<<<<<<<<<<<<<<<<<<<" <<endl; |
| 433 | cout << "controller_type: "<< controller_type <<endl; |
| 434 | cout << "Takeoff_height : "<< Takeoff_height<<" [m] "<<endl; |
| 435 | cout << "Disarm_height : "<< Disarm_height <<" [m] "<<endl; |
| 436 | cout << "Land_speed : "<< Land_speed <<" [m/s] "<<endl; |
| 437 | cout << "geo_fence_x : "<< geo_fence_x[0] << " [m] to "<<geo_fence_x[1] << " [m]"<< endl; |
| 438 | cout << "geo_fence_y : "<< geo_fence_y[0] << " [m] to "<<geo_fence_y[1] << " [m]"<< endl; |
| 439 | cout << "geo_fence_z : "<< geo_fence_z[0] << " [m] to "<<geo_fence_z[1] << " [m]"<< endl; |
| 440 | |
| 441 | } |
| 442 | |
| 443 | int check_failsafe() |
| 444 | { |