source: flair-src/trunk/lib/FlairFilter/src/ButterworthLowPass_impl.cpp@ 147

Last change on this file since 147 was 147, checked in by Sanahuja Guillaume, 7 years ago

modif euler/lowpass

File size: 3.0 KB
RevLine 
[10]1// %flair:license{
[15]2// This file is part of the Flair framework distributed under the
3// CECILL-C License, Version 1.0.
[10]4// %flair:license}
[7]5// created: 2013/12/10
6// filename: ButterworthLowPass_impl.cpp
7//
8// author: Guillaume Sanahuja
9// Copyright Heudiasyc UMR UTC/CNRS 7253
10//
11// version: $Id: $
12//
13// purpose: objet permettant le calcul d'un filtre passe bas de Butterworth
14//
15//
16/*********************************************************************/
17
18#include "ButterworthLowPass_impl.h"
19#include "ButterworthLowPass.h"
20#include <cvmatrix.h>
21#include <Layout.h>
22#include <GroupBox.h>
23#include <SpinBox.h>
24#include <DoubleSpinBox.h>
25
26using std::string;
27using namespace flair::core;
28using namespace flair::gui;
29using namespace flair::filter;
30
[15]31ButterworthLowPass_impl::ButterworthLowPass_impl(ButterworthLowPass *self,
32 const LayoutPosition *position,
33 string name, int order) {
34 // init UI
35 GroupBox *reglages_groupbox = new GroupBox(position, name);
36 T = new DoubleSpinBox(reglages_groupbox->NewRow(), "period, 0 for auto", " s",
37 0, 10, 0.01);
38 cutoff = new DoubleSpinBox(reglages_groupbox->NewRow(), "cutoff frequency",
39 " Hz", 0, 10000, 0.1, 2, 1);
[7]40
[15]41 cvmatrix_descriptor *desc = new cvmatrix_descriptor(1, 1);
42 desc->SetElementName(0, 0, "output");
43 output = new cvmatrix(self, desc, floatType, name);
[7]44
[15]45 output->SetValue(0, 0, 0);
[7]46
[15]47 f = new PoleFilter(order);
[7]48
[147]49 if (T->Value() != 0) {
[15]50 f->setup(1. / T->Value(), cutoff->Value());
[147]51 }
52
[15]53 f->reset();
[7]54
[15]55 first_update = true;
[147]56 this->order=order;
[7]57}
58
[15]59ButterworthLowPass_impl::~ButterworthLowPass_impl() { delete f; }
[7]60
[15]61void ButterworthLowPass_impl::UpdateFrom(const io_data *data) {
62 float result;
63 cvmatrix *input = (cvmatrix *)data;
[147]64 float delta_t;
65
66 if (T->ValueChanged()) {
[15]67 if (T->Value() != 0) {
68 f->setup(1. / T->Value(), cutoff->Value());
[147]69 settingsChanged(input->Value(0, 0));
[7]70 }
[15]71 }
[7]72
[147]73 if (T->Value() == 0) {
74 delta_t = (float)(data->DataTime() - previous_time) / 1000000000.;
75 f->setup(1. / delta_t, cutoff->Value());
76 } else {
77 delta_t=T->Value();
78 }
79
[15]80 // on prend une fois pour toute les mutex et on fait des accès directs
81 output->GetMutex();
82 input->GetMutex();
[7]83
[147]84 if (cutoff->ValueChanged()) {
[15]85 f->setup(1. / delta_t, cutoff->Value());
[147]86 settingsChanged(input->ValueNoMutex(0, 0));
[15]87 }
[7]88
[15]89 if (first_update == true) {
90 first_update = false;
91 } else {
92 result = f->filter(input->ValueNoMutex(0, 0));
93 output->SetValueNoMutex(0, 0, result);
94 }
[7]95
[15]96 input->ReleaseMutex();
97 output->ReleaseMutex();
[7]98
[15]99 output->SetDataTime(data->DataTime());
100 previous_time = data->DataTime();
[7]101}
[147]102
103//ne gere pas les oscillations (s'arrete des qu'une valeure est bonne a 5%)
104void ButterworthLowPass_impl::settingsChanged(float inputValue) {
105 float result=f->filter(inputValue);
106
107 while(result<inputValue*0.95 || result>inputValue*1.05) {
108 result=f->filter(inputValue);
109 }
110}
Note: See TracBrowser for help on using the repository browser.