Changeset 15 in flair-src for trunk/lib/FlairMeta/src/MetaUsRangeFinder.cpp
- Timestamp:
- 04/08/16 15:40:57 (7 years ago)
- File:
-
- 1 edited
Legend:
- Unmodified
- Added
- Removed
-
trunk/lib/FlairMeta/src/MetaUsRangeFinder.cpp
r10 r15 35 35 using namespace flair::sensor; 36 36 37 namespace flair { namespace meta38 {37 namespace flair { 38 namespace meta { 39 39 40 MetaUsRangeFinder::MetaUsRangeFinder(UsRangeFinder* us): Object(us,us->ObjectName()) { 41 this->us=us; 42 pbas_z=new ButterworthLowPass(us,us->GetLayout()->NewRow(),"Passe bas",3); 43 vz_euler=new EulerDerivative(pbas_z,us->GetLayout()->NewRow(),"Vz"); 44 pbas_vz=new ButterworthLowPass(vz_euler,us->GetLayout()->NewRow(),"Passe bas v",3); 45 40 MetaUsRangeFinder::MetaUsRangeFinder(UsRangeFinder *us) 41 : Object(us, us->ObjectName()) { 42 this->us = us; 43 pbas_z = 44 new ButterworthLowPass(us, us->GetLayout()->NewRow(), "Passe bas", 3); 45 vz_euler = new EulerDerivative(pbas_z, us->GetLayout()->NewRow(), "Vz"); 46 pbas_vz = new ButterworthLowPass(vz_euler, us->GetLayout()->NewRow(), 47 "Passe bas v", 3); 46 48 } 47 49 48 MetaUsRangeFinder::~MetaUsRangeFinder() { 50 MetaUsRangeFinder::~MetaUsRangeFinder() {} 49 51 52 void MetaUsRangeFinder::UseDefaultPlot(void) { 53 us->UseDefaultPlot(); 54 55 us->GetPlot()->AddCurve(pbas_z->Matrix()->Element(0), DataPlot::Blue); 56 57 vz_plot = new DataPlot1D(us->GetPlotTab()->LastRowLastCol(), "vz", -2, 2); 58 vz_plot->AddCurve(vz_euler->Matrix()->Element(0)); 59 vz_plot->AddCurve(pbas_vz->Matrix()->Element(0), DataPlot::Blue); 50 60 } 51 61 52 void MetaUsRangeFinder::UseDefaultPlot(void) { 53 us->UseDefaultPlot(); 62 gui::DataPlot1D *MetaUsRangeFinder::GetZPlot() { return us->GetPlot(); } 54 63 55 us->GetPlot()->AddCurve(pbas_z->Matrix()->Element(0),DataPlot::Blue); 64 gui::DataPlot1D *MetaUsRangeFinder::GetVzPlot() { return vz_plot; } 56 65 57 vz_plot=new DataPlot1D(us->GetPlotTab()->LastRowLastCol(),"vz",-2,2); 58 vz_plot->AddCurve(vz_euler->Matrix()->Element(0)); 59 vz_plot->AddCurve(pbas_vz->Matrix()->Element(0),DataPlot::Blue); 60 } 66 float MetaUsRangeFinder::z(void) const { return pbas_z->Output(); } 61 67 62 gui::DataPlot1D *MetaUsRangeFinder::GetZPlot() { 63 return us->GetPlot(); 64 } 65 66 gui::DataPlot1D *MetaUsRangeFinder::GetVzPlot() { 67 return vz_plot; 68 } 69 70 float MetaUsRangeFinder::z(void) const { 71 return pbas_z->Output(); 72 } 73 74 float MetaUsRangeFinder::Vz(void) const { 75 return pbas_vz->Output(); 76 } 68 float MetaUsRangeFinder::Vz(void) const { return pbas_vz->Output(); } 77 69 78 70 } // end namespace sensor
Note:
See TracChangeset
for help on using the changeset viewer.