P2 halbfertig
Fork of Library by
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_ */