Library containing essential automation elements with parameters in continuous Laplace domain, and implemented with fixed sample time. This means that "out" member functions should be called using Ticker object.
Dependents: CurrentMeasurement Zavrsni_rad_NXP_cup HC-SR04 Nucleo_SSD1306_DS1302_ESP8266_AM2320_BME280 ... more
PT1.cpp
- Committer:
- tbjazic
- Date:
- 2015-01-22
- Revision:
- 1:b9e11da0f2eb
- Parent:
- 0:3dd7aeceee65
File content as of revision 1:b9e11da0f2eb:
#include "PT1.h" PT1::PT1() { u = y = u_p1 = y_p1 = 0; setParameters(1, 1, 0.1); } PT1::PT1(double K_, double T_1_, double T_d_) { u = y = u_p1 = y_p1 = 0; setParameters(K_, T_1_, T_d_); } void PT1::setParameters(double K_, double T_1_, double T_d_) { if (T_d_ > 0) T_d = T_d_; else T_d = 0.1; K = K_; T_1 = T_1_; a_1 = -exp(-T_d/T_1); b_1 = K * (1 + a_1); } double PT1::out() { y = -a_1 * y_p1 + b_1 * u_p1; y_p1 = y; u_p1 = u; return y; } void PT1::in(double u_) { u = u_; }