P2 halbfertig

Fork of Library by St Knz

Controller.h

Committer:
kueenste
Date:
2018-03-10
Revision:
2:6dd39662e6e5
Parent:
0:bb408887ab78

File content as of revision 2:6dd39662e6e5:

/*
 * Controller.h
 * Copyright (c) 2018, ZHAW
 * All rights reserved.
 */

#ifndef CONTROLLER_H_
#define CONTROLLER_H_

#include <cstdlib>
#include <mbed.h>
#include "EncoderCounter.h"
#include "Motion.h"
#include "LowpassFilter.h"

/**
 * This class implements the coordinate transformation, speed control and
 * the position estimation of a mobile robot with differential drive.
 */
class Controller {

    public:
    
                    Controller(PwmOut& pwmLeft, PwmOut& pwmRight, EncoderCounter& counterLeft, EncoderCounter& counterRight);
        virtual     ~Controller();
        void        setTranslationalVelocity(float velocity);
        void        setRotationalVelocity(float velocity);
        float       getActualTranslationalVelocity();
        float       getActualRotationalVelocity();
        
    private:
        
        static const float  PERIOD;
        static const float  COUNTS_PER_TURN;
        static const float  LOWPASS_FILTER_FREQUENCY;
        static const float  KN;
        static const float  KP;
        static const float  MAX_VOLTAGE;
        static const float  MIN_DUTY_CYCLE;
        static const float  MAX_DUTY_CYCLE;
        
        static const float R;
        static const float r;
        
        PwmOut&             pwmLeft;
        PwmOut&             pwmRight;
        EncoderCounter&     counterLeft;
        EncoderCounter&     counterRight;
        Motion              translationalMotion;
        Motion              rotationalMotion;
        float               translationalVelocity;
        float               rotationalVelocity;
        float               actualTranslationalVelocity;
        float               actualRotationalVelocity;
        short               previousValueCounterLeft;
        short               previousValueCounterRight;
        LowpassFilter       speedLeftFilter;
        LowpassFilter       speedRightFilter;
        float               desiredSpeedLeft;
        float               desiredSpeedRight;
        float               actualSpeedLeft;
        float               actualSpeedRight;
        Ticker              ticker;
        

        void                run();
};

#endif /* CONTROLLER_H_ */