File content as of revision 19:377887760869:

#include "Target.hpp"


Target::Target(ServomotorInterface& servomotor, LedControllerInterface& led_controller, XbeeTransmitterInterface& xbee_transmitter):
    servomotor(servomotor),
    led_controller(led_controller),
    xbee_transmitter(xbee_transmitter)
{
}

void Target::execute_command(Mode mode, int timeout_ms)
{
    if(mode == Ally)
    {
        ally_command();
    }
    else
    {
        enemy_command();
    }
}


void Target::ally_command()
{
    servomotor.set_position_up();
}

void Target::enemy_command()
{
    led_controller.turn_on();
    servomotor.set_position_up();
}

std::vector<uint8_t> Target::generate_message(uint8_t target_number, Result result, uint16_t timeout_ms) const
{
    const uint8_t target_number_and_result = (target_number << 3) + result;
    const uint8_t timeout_ms_msb = timeout_ms >> 8;
    const uint8_t timeout_ms_lsb = (timeout_ms << 8) >> 8;

    std::vector<uint8_t> message;

    message.push_back(target_number_and_result);
    message.push_back(timeout_ms_msb);
    message.push_back(timeout_ms_lsb);

    return message;
}