109 lines
3.1 KiB
C++
109 lines
3.1 KiB
C++
/*
|
|
* MoveToPoint.hh
|
|
*
|
|
* Created on: 8 èþë. 2020 ã.
|
|
* Author: LeonidTitov
|
|
*/
|
|
|
|
#ifndef UMLIBRARY_TECHNOLOGICAL_FUNCTION_MOVETOPOINT_HH_
|
|
#define UMLIBRARY_TECHNOLOGICAL_FUNCTION_MOVETOPOINT_HH_
|
|
|
|
#include "../ITechFunction.hh"
|
|
|
|
#include "../../processing/acs/VectorAsyncInterface.hh"
|
|
|
|
#include "../adapter/ControlSystemWrapper.hpp"
|
|
|
|
#include "../../systemic/IProcess.hh"
|
|
#include "../../systemic/Timer.hh"
|
|
|
|
namespace technological { namespace function {
|
|
|
|
class MoveToPoint : public ITechFunction, public systemic::IProcess {
|
|
public:
|
|
struct Input {
|
|
float position_stp; //!<Çàäàííîå àáñîëþòíîå ïîëîæåíèå, ðàä.
|
|
float torque_lim; //!<Îãðàíè÷åíèå ìîìåíòà, Í*ì.
|
|
float speed_lim; //!<Îãðàíè÷åíèå ñêîðîñòè, ðàä/ñ.
|
|
float acc_lim; //!<Îãðàíè÷åíèå óñêîðåíèÿ, ðàä/ñ^2.
|
|
};
|
|
|
|
struct Output {
|
|
float position; //!<Ïîçèöèÿ, êîòîðóþ óäàëîñü äîñòè÷ü, ðàä.
|
|
float setpoint; //!<Öåëåâàÿ ïîçèöèÿ, ðàä.
|
|
};
|
|
|
|
bool run( const char * value, std::size_t size );
|
|
void stop();
|
|
bool getResult( char * value, std::size_t size ) const;
|
|
short getState() const;
|
|
|
|
void process();
|
|
|
|
MoveToPoint( ResourceKeeper< technological::adapter::TieInterface<vector::ITechValue> > & control_system_wrapper,
|
|
ResourceKeeper<vector::ITechValue> & speed_limit,
|
|
ResourceKeeper<vector::ITechValue> & torque_limit,
|
|
ResourceKeeper<vector::ITechValue> & acc_limit
|
|
);
|
|
|
|
struct Setting {
|
|
float retention_accuracy; //!<Òî÷íîñòü äîñòèæåíèÿ ïîçèöèè.
|
|
float on_position_timeout; //!<Âðåìÿ óäåðæàíèÿ çàäàííîãî ïîëîæåíèÿ, ñ.
|
|
|
|
Setting();
|
|
bool isValid();
|
|
};
|
|
|
|
void configure( Setting & config );
|
|
|
|
//Ñòàòóñû îøèáîê ïðè÷èíû íåçàïóñêà:
|
|
bool isSizeError() const; //!<Îøèáêà ðàçìåðà âõîäíûõ äàííûõ.
|
|
bool isInvalidInput() const; //!<Íåêîððåòíîñòü ïàðàìåòðîâ çàïóñêà.
|
|
bool isControlSystemBusy() const; //!<Îøèáêà ôîðìèðîâàíèÿ ñèñòåìû óïðàâëåíèÿ.
|
|
|
|
protected:
|
|
virtual void on_start( Input & input, float start_point, systemic::time_t on_position_timeout ) {}
|
|
virtual void in_progress() {}
|
|
virtual void on_end() {}
|
|
|
|
enum RunErrors {
|
|
Empty,
|
|
SizeError,
|
|
InvalidInput,
|
|
ControlSystemBusy,
|
|
} run_result;
|
|
|
|
private:
|
|
bool handle( Input & input );
|
|
|
|
Locable< technological::adapter::TieInterface<vector::ITechValue> > wrapper;
|
|
vector::ITechValue * control_system;
|
|
|
|
Locable<vector::ITechValue> speed_limit;
|
|
Locable<vector::ITechValue> torque_limit;
|
|
Locable<vector::ITechValue> acc_limit;
|
|
|
|
struct {
|
|
float speed_limit = 0.0f;
|
|
float torque_limit = 0.0f;
|
|
float acceleration_limit = 0.0f;
|
|
} stored;
|
|
|
|
float setpoint;
|
|
float retention_accuracy; //!<Òî÷íîñòü äîñòèæåíèÿ ïîçèöèè.
|
|
|
|
static bool validate( Input & );
|
|
void apply(Input &input);
|
|
|
|
bool moving;
|
|
|
|
Output result;
|
|
|
|
systemic::Timer on_position_timer;
|
|
systemic::time_t timeout;
|
|
};
|
|
|
|
}}
|
|
|
|
#endif /* UMLIBRARY_TECHNOLOGICAL_FUNCTION_MOVETOPOINT_HH_ */
|