KJ2016Tempo.h

#ifndef KJ2016TEMPO_H
#define KJ2016TEMPO_H

/**
 * @brief Runs the strategy for Krabi Junior 2016
 *
 * No odometry or feedback this year on this bot. It's fully temporised and driven by continuous servos.
 */
class KJ2016Tempo
{
    static const float KJ_INTERAXIS        = 100.f; // To update
    static const float KJ_WHEEL_DIAMETER   = 60.f;
    static const float SERVO_MAX_RPM       = 59.f;

    public:
        /**
         * @brief Runs the strategy
         */
        static void run(bool isYellow);

        ~KJ2016Tempo();

    private:
        const unsigned int LEFT_SERVO_ID;
        const unsigned int RIGHT_SERVO_ID;
        const float SERVO_SPEED_FACTOR;

        void enginesStart();
        void enginesStop();

        void turn90(bool toLeft);

        void move(int distance);

        KJ2016Tempo(unsigned int leftServoID, unsigned int rightServoID);
};

#endif // KJ2016TEMPO_H