#include <stdio.h>
#include <iostream>
#include <vector>
#include <string>
#include <bitset>
#include <unordered_map>
#include <math.h>

#define HOME (0, 0)

Point mission;
Bool missionXorY;

//Bool isPosXDone = false;
//Bool isPosYDone = false;

bool isAtPosition(){}

/*

*/
void calculate_next_mission()
{
    /*
    Är jag i korrekt x eller kan inte köra mer i x, byt till y.

    Är jag i korrekt y eller kan inte köra mer i y, byt till x.

    om vi är i rätt x men kan inte flytta oss i y, då måste vi flytta oss i x.
    */

   if(canDriveX() & !isAtPosX())
   {

   }
   else if(canDriveY() & !isAtPosY())
   {

   }
}

bool isAtPosX(){}

bool isAtPosY(){}

void work_towards_next_pos(){}

void drive_forward(int speedX, int speedY){}

void drive_stop(){}

void drive_left(){}

void drive_right(){}

int main()
{
    if(isAtPosition())
    {
        calculate_next_mission();
    }
    else
    {
        work_towards_next_pos();
    }
}