14.15 atDestination

This function checks to see if we have arrived at the target destination of some function. This is achieved by checking if the distance to the target is less than 1 meaning we are relatively close.

bool NaoBehavior::atDestination(VecPosition mypos, VecPosition target){
    double distance =  mypos.getDistanceTo(target);

    if(distance <1){
        return true;
    }
    return false;
}