source: flair-src/trunk/lib/FlairFilter/src/EulerDerivative_impl.cpp @ 157

Last change on this file since 157 was 148, checked in by Sanahuja Guillaume, 5 years ago

m

File size: 3.3 KB
Line 
1// %flair:license{
2// This file is part of the Flair framework distributed under the
3// CECILL-C License, Version 1.0.
4// %flair:license}
5//  created:    2011/05/01
6//  filename:   EulerDerivative.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'une derivee d'Euler
14//
15//
16/*********************************************************************/
17
18#include "EulerDerivative.h"
19#include "EulerDerivative_impl.h"
20#include <cvmatrix.h>
21#include <Layout.h>
22#include <GroupBox.h>
23#include <DoubleSpinBox.h>
24
25using std::string;
26using namespace flair::core;
27using namespace flair::gui;
28using namespace flair::filter;
29
30EulerDerivative_impl::EulerDerivative_impl(EulerDerivative *self,
31                                           const LayoutPosition *position,
32                                           string name,
33                                           const cvmatrix *init_value) {
34  first_update = true;
35 
36  if (init_value != NULL) {
37    // init output matrix of same size as init
38    cvmatrix_descriptor *desc =new cvmatrix_descriptor(init_value->Rows(), init_value->Cols());
39
40    for (int i = 0; i < init_value->Rows(); i++) {
41      for (int j = 0; j < init_value->Cols(); j++) {
42        desc->SetElementName(i, j, init_value->Name(i, j));
43      }
44    }
45    output = new cvmatrix(self, desc,init_value->GetDataType().GetElementDataType(), name);
46    delete desc;
47    for (int i = 0; i < init_value->Rows(); i++) {
48      for (int j = 0; j < init_value->Cols(); j++) {
49        output->SetValue(i, j, init_value->Value(i,j));
50      }
51    }
52  } else {
53    // if NULL, assume dimension 1, and init=0
54    cvmatrix_descriptor *desc = new cvmatrix_descriptor(1, 1);
55    desc->SetElementName(0, 0, "output");
56    output = new cvmatrix(self, desc, floatType, name);
57    delete desc;
58  }
59 
60 
61  cvmatrix_descriptor *desc = new cvmatrix_descriptor(output->Rows(), output->Cols());
62  prev_value = new cvmatrix(self, desc, output->GetDataType().GetElementDataType(), name);
63
64
65  // init UI
66  GroupBox *reglages_groupbox = new GroupBox(position, name);
67  T = new DoubleSpinBox(reglages_groupbox->NewRow(), "period, 0 for auto:",
68                        " s", 0, 1, 0.01);
69}
70
71EulerDerivative_impl::~EulerDerivative_impl() {}
72
73void EulerDerivative_impl::UpdateFrom(const io_data *data) {
74  float delta_t;
75  cvmatrix *input = (cvmatrix *)data;
76
77  // on prend une fois pour toute les mutex et on fait des accès directs
78  output->GetMutex();
79  input->GetMutex();
80
81  if (first_update == true) {
82    for (int i = 0; i < input->Rows(); i++) {
83      for (int j = 0; j < input->Cols(); j++) {
84        prev_value->SetValueNoMutex(i, j, input->ValueNoMutex(i, j));
85      }
86    }
87    first_update = false;
88  } else {
89    if (T->Value() == 0) {
90      delta_t = (float)(data->DataTime() - previous_time) / 1000000000.;
91    } else {
92      delta_t = T->Value();
93    }
94
95    for (int i = 0; i < input->Rows(); i++) {
96      for (int j = 0; j < input->Cols(); j++) {
97        output->SetValueNoMutex(
98            i, j, (input->ValueNoMutex(i, j) - prev_value->ValueNoMutex(i, j)) /
99                      delta_t);
100        prev_value->SetValueNoMutex(i, j, input->ValueNoMutex(i, j));
101      }
102    }
103  }
104
105  input->ReleaseMutex();
106  output->ReleaseMutex();
107
108  output->SetDataTime(data->DataTime());
109  previous_time = data->DataTime();
110}
Note: See TracBrowser for help on using the repository browser.