int main() {
krpc::Client conn = krpc::connect("Sub-orbital flight");
krpc::services::KRPC krpc(&conn);
krpc::services::SpaceCenter space_center(&conn);
auto vessel = space_center.active_vessel();
vessel.auto_pilot().target_pitch_and_heading(90, 90);
vessel.auto_pilot().engage();
vessel.control().set_throttle(1);
std::this_thread::sleep_for(std::chrono::seconds(1));
std::cout << "Launch!" << std::endl;
vessel.control().activate_next_stage();
typedef krpc::services::KRPC::Expression Expr;
{
auto solid_fuel = vessel.resources().amount_call("SolidFuel");
auto expr = Expr::less_than(
conn, Expr::call(conn, solid_fuel), Expr::constant_float(conn, 0.1));
auto event = krpc.add_event(expr);
event.acquire();
event.wait();
event.release();
}
std::cout << "Booster separation" << std::endl;
vessel.control().activate_next_stage();
{
auto mean_altitude = vessel.flight().mean_altitude_call();
auto expr = Expr::greater_than(
conn, Expr::call(conn, mean_altitude), Expr::constant_double(conn, 10000));
auto event = krpc.add_event(expr);
event.acquire();
event.wait();
event.release();
}
std::cout << "Gravity turn" << std::endl;
vessel.auto_pilot().target_pitch_and_heading(60, 90);
{
auto apoapsis_altitude = vessel.orbit().apoapsis_altitude_call();
auto expr = Expr::greater_than(
conn, Expr::call(conn, apoapsis_altitude), Expr::constant_double(conn, 100000));
auto event = krpc.add_event(expr);
event.acquire();
event.wait();
event.release();
}
std::cout << "Launch stage separation" << std::endl;
vessel.control().set_throttle(0);
std::this_thread::sleep_for(std::chrono::seconds(1));
vessel.control().activate_next_stage();
vessel.auto_pilot().disengage();
{
auto srf_altitude = vessel.flight().surface_altitude_call();
auto expr = Expr::less_than(
conn, Expr::call(conn, srf_altitude), Expr::constant_double(conn, 1000));
auto event = krpc.add_event(expr);
event.acquire();
event.wait();
event.release();
}
vessel.control().activate_next_stage();
while (vessel.flight(vessel.orbit().body().reference_frame()).vertical_speed() < -0.1) {
std::cout << "Altitude = " << vessel.flight().surface_altitude() << " meters" << std::endl;
std::this_thread::sleep_for(std::chrono::seconds(1));
}
std::cout << "Landed!" << std::endl;
}
int process()
{
struct pollfd fds[4];
int nfds;
int rc,i,timeout,ret,mret;
struct timeval ts;
struct timezone tz;
timeout = 20;
ret = 0;
/*Send all outstanding commands from command buffer*/
if (strlen(cmdbuffer) > 0) {
udp_send_command(cmdbuffer);
bzero(cmdbuffer,BUFLEN);
}
// gettimeofday(&ts,&tz);
// last_timestamp_nav=ts.tv_sec*1000+ts.tv_usec/1000 + 5000;
nfds = 0;
if (vid_state == 1){
fds[nfds].fd = vid_sock;
fds[nfds++].events = POLLIN;
}
if (nav_state == 1){
fds[nfds].fd = nav_sock;
fds[nfds++].events = POLLIN;
}
if (web_state == 1){
if (http_fd){
fds[nfds].fd = http_fd;
fds[nfds++].events = POLLIN;
}
else {
fds[nfds].fd = web_sock;
fds[nfds++].events = POLLIN;
}
}
rc = poll(fds, nfds, timeout);
if (rc < 0) {
perror(" poll() failed");
}
if (rc == 0) {
/* Ignore, just finish the duty cycle */
}
else {
for (i = 0; i < nfds; i++) {
if(fds[i].revents == 0)
continue;
if(fds[i].revents != POLLIN) {
printf(" Error! revents = %d\n", fds[i].revents);
}
if (fds[i].fd == nav_sock) {
int size;
gettimeofday(&ts,&tz);
last_timestamp_nav=ts.tv_sec*1000+ts.tv_usec/1000;
size = recvfrom (nav_sock, navdata_buffer, NAVDATA_BUFFER_SIZE, 0,
(struct sockaddr *)&si_nav,
(socklen_t *)&slen);
decode_navdata(navdata_buffer,size);
}
if (fds[i].fd == vid_sock) {
int size;
char tmpbuffer[8192];
size = read (vid_sock, tmpbuffer, 8192);
send_vid_data(tmpbuffer,size);
//printf("Siz=%d\n",size);
}
if (fds[i].fd == web_sock) {
http_fd = accept_web(web_sock);
}
if (fds[i].fd == http_fd) {
handle_web(http_fd);
http_fd = 0;
}
}
}
/* Timeout Handling
* Timeouts are handled diffenently for input and navdata.
* */
gettimeofday(&ts,&tz);
unsigned int msecs = ts.tv_sec*1000+ts.tv_usec/1000;
/* Navdata timeout
* After two seconds without navdata warn, and inform
* other handlers. */
if ((msecs - last_timestamp_nav) > 2000) {
// nav timeout
if (!flag_no_navdata ) {
printf("!WARN:navdata\n");
navdata_valid = 0;
}
flag_no_navdata = 1;
}
else {
flag_no_navdata = 0;
}
/* Control timeout handling
* Two seconds without a control (move) command put the
* drone in hover mode.
*/
if ((msecs - last_timestamp_command) > 2000) {
if (!flag_no_command ) {
printf("!WARN:command timeout\n");
command_idle();
}
flag_no_command = 1;
}
else {
flag_no_command = 0;
}
/* If waiting for a config confirmation wait until the COMMAND_MASK has
* gone to 1 and then been reset. */
if (config_confirm_wait == 1) {
if (navdata_unpacked.mykonos_state & MYKONOS_COMMAND_MASK) {
config_confirm_wait++;
char buffer[BUFLEN];
bzero(buffer,BUFLEN);
addATCTRL(buffer,5,0);
udp_send_command(buffer);
}
else {
return 2; // Run process() AGAIN
}
}
else {
if (config_confirm_wait == 2) {
if (!(navdata_unpacked.mykonos_state & MYKONOS_COMMAND_MASK)) {
config_confirm_wait = 0;
}
else {
return 2; // Run process() AGAIN
}
}
}
// Execute automations
if (auto_pilot()){
printf("P\n");
ret = 4;
}
// Monitor limits and alerts
// if monitor reuturns 128 it wants to run again
mret = auto_monitor();
if (mret == 128)
return 2;
else
ret = ret | (mret << 8);
// Send an update packet to the drone
// also: current flight instructions
update_drone();
logdata();
/* If the internal controller has been selected
* we keep returning 2 here, this makes control
* from the app impossible, except if it overrides
* even that. */
if (lockout_control)
ret = 2;
return ret;
}
