source: flair-src/trunk/tools/FlairGCS/src/UsSensorPlot.cpp @ 221

Last change on this file since 221 was 221, checked in by Sanahuja Guillaume, 4 years ago

add us plot

File size: 7.0 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#include "UsSensorPlot.h"
6#include "Layout.h"
7#include <qwt_plot.h>
8#include <qwt_plot_curve.h>
9#include <qwt_plot_grid.h>
10#include <qwt_plot_magnifier.h>
11#include <qwt_plot_canvas.h>
12#include <qwt_scale_widget.h>
13#include <qwt_legend_label.h>
14#include <qwt_legend.h>
15#include <qwt_plot_panner.h>
16#include <qwt_plot_rescaler.h>
17#include <qwt_plot_marker.h>
18#include <QMouseEvent>
19#include <QMenu>
20#include <QInputDialog>
21#include <qendian.h>
22#include <qwt_symbol.h>
23
24UsSensorPlot::UsSensorPlot(Layout *parent, int row, int col, QString plot_name,
25                       QString y_name, float ymin, float ymax, uint32_t nbSamples,QString datasType,bool enabled, int period)
26    : DataRemote(plot_name, "UsSensorPlot", parent, enabled, period) {
27  plot = new QwtPlot(NULL);
28  plot->setEnabled(enabled);
29
30  parent->addWidget(plot, row, col);
31  visible_widget = plot;
32 
33  this->nbSamples=nbSamples;
34  this->datasType=datasType;
35
36#if QT_VERSION >= 0x040000
37#ifdef Q_WS_X11
38  /*
39     Qt::WA_PaintOnScreen is only supported for X11, but leads
40     to substantial bugs with Qt 4.2.x/Windows
41   */
42  plot->canvas()->setAttribute(Qt::WA_PaintOnScreen, true);
43#endif
44#endif
45
46  alignScales();
47
48  // Assign a title
49  plot->setTitle(plot_name);
50
51  // Axis
52  plot->setAxisTitle(QwtPlot::xBottom, "samples");
53  setXAxisScale(0, nbSamples-1);
54
55  plot->setAxisTitle(QwtPlot::yLeft, y_name);
56  setYAxisScale(ymin, ymax);
57
58  //QwtPlotRescaler *rescaler = new QwtPlotRescaler(plot->canvas());
59  //rescaler->setRescalePolicy(QwtPlotRescaler::Fixed);
60  /*
61 rescaler->setReferenceAxis(QwtPlot::xBottom);
62 rescaler->setAspectRatio(QwtPlot::yLeft, 1.0);*/
63
64  // grid
65  QwtPlotGrid *grid = new QwtPlotGrid;
66  grid->setPen(QPen(Qt::black, 0, Qt::DotLine));
67  grid->attach(plot);
68
69  // zoomer
70  QwtPlotMagnifier *zoomer = new QwtPlotMagnifier(plot->canvas());
71  zoomer->setMouseButton(Qt::RightButton, Qt::ControlModifier);
72
73  // scroller
74  QwtPlotPanner *scroller = new QwtPlotPanner(plot->canvas());
75
76  plot->canvas()->installEventFilter(this);
77 
78  dx = (double *)malloc(nbSamples* sizeof(double));
79  dy = (double *)malloc(nbSamples* sizeof(double));
80  for (int i = 0; i < nbSamples; i++) dx[i] = i;
81 
82  // Insert new curve
83  datas = new QwtPlotCurve();
84  datas->attach(plot);
85  datas->setPen(QPen(QColor(255, 0, 0, 255)));
86
87  datas->setVisible(true);
88
89  // Attach (don't copy) data
90  datas->setRawSamples(dx,dy, nbSamples);
91
92  if (datasType == "float") {
93    receivesize += sizeof(float);
94  } else if (datasType == "int8_t" || datasType == "uint8_t") {
95    receivesize += sizeof(int8_t);
96  } else if (datasType == "int16_t" || datasType == "uint16_t") {
97    receivesize += sizeof(int16_t);
98  } else {
99    printf("UsSensorPlot::unknown type %s\n",
100           datasType.toLocal8Bit().constData());
101  }
102 
103  firstPeakStart = new QwtPlotMarker();
104  QwtSymbol* s=new QwtSymbol( QwtSymbol::Diamond, Qt::blue, Qt::NoPen, QSize( 10, 10 ) );
105  firstPeakStart->setSymbol(s);
106  //firstPeakStart->setValue( QPointF( 1000, 200 ) );
107  //m->setLabel("toto" );
108  firstPeakStart->attach( plot );
109 
110  firstPeakEnd = new QwtPlotMarker();
111  //QwtSymbol* s=new QwtSymbol( QwtSymbol::Diamond, Qt::blue, Qt::NoPen, QSize( 10, 10 ) );
112  firstPeakEnd->setSymbol(s);
113  firstPeakEnd->attach( plot );
114 
115  secondPeakStart = new QwtPlotMarker();
116  secondPeakStart->setSymbol(s);
117  secondPeakStart->attach( plot );
118 
119  secondPeakEnd = new QwtPlotMarker();
120  secondPeakEnd->setSymbol(s);
121  secondPeakEnd->attach( plot );
122}
123
124UsSensorPlot::~UsSensorPlot() {
125  free(dx);
126  free(dy);
127}
128
129void UsSensorPlot::XmlEvent(QDomElement dom) {
130  XmlSetup(dom);
131}
132
133bool UsSensorPlot::eventFilter(QObject *o, QEvent *e) {
134  if (o == plot->canvas()) {
135    switch (e->type()) {
136    case QEvent::MouseButtonPress: {
137      mousePressEvent((QMouseEvent *)e);
138      break;
139    }
140
141    default:
142      break;
143    }
144  }
145  return plot->eventFilter(o, e);
146}
147
148void UsSensorPlot::setXAxisScale(float xmin, float xmax) {
149  xmin_orig = xmin;
150  xmax_orig = xmax;
151  plot->setAxisScale(QwtPlot::xBottom, xmin_orig, xmax_orig);
152}
153
154void UsSensorPlot::setYAxisScale(float ymin, float ymax) {
155  ymin_orig = ymin;
156  ymax_orig = ymax;
157  plot->setAxisScale(QwtPlot::yLeft, ymin_orig, ymax_orig);
158}
159
160//
161//  Set a plain canvas frame and align the scales to it
162//
163void UsSensorPlot::alignScales(void) {
164  // The code below shows how to align the scales to
165  // the canvas frame, but is also a good example demonstrating
166  // why the spreaded API needs polishing.
167  /*
168      plot->canvas()->setFrameStyle(QFrame::Box | QFrame::Plain );
169      plot->canvas()->setLineWidth(1);
170  */
171  for (int i = 0; i < QwtPlot::axisCnt; i++) {
172    QwtScaleWidget *scaleWidget = (QwtScaleWidget *)plot->axisWidget(i);
173    if (scaleWidget)
174      scaleWidget->setMargin(0);
175
176    QwtScaleDraw *scaleDraw = (QwtScaleDraw *)plot->axisScaleDraw(i);
177    if (scaleDraw)
178      scaleDraw->enableComponent(QwtAbstractScaleDraw::Backbone, false);
179  }
180}
181
182void UsSensorPlot::BufEvent(char **buf, int *buf_size, uint16_t period,bool big_endian) {
183  plot->setEnabled(IsEnabled());
184  if (IsEnabled() == false || RefreshRate_ms() != period)
185    return;
186
187  if (datasType == "float") {
188    float *data=(float*)*buf;
189    for (int i = 0; i < nbSamples; i++) {
190      dy[i]=data[i];
191    }
192    *buf += nbSamples*sizeof(float);
193  } else if (datasType == "int8_t") {
194    int8_t *data=(int8_t*)*buf;
195    for (int i = 0; i < nbSamples; i++) {
196      dy[i]=data[i];
197    }
198    *buf += nbSamples*sizeof(int8_t);
199   } else if (datasType == "uint8_t") {
200    uint8_t *data=(uint8_t*)*buf;
201    for (int i = 0; i < nbSamples; i++) {
202      dy[i]=data[i];
203    }
204    *buf += nbSamples*sizeof(uint8_t);
205  } else if (datasType == "int16_t") {
206    int16_t *data=(int16_t*)*buf;
207    for (int i = 0; i < nbSamples; i++) {
208      dy[i]=data[i];
209    }
210    *buf += nbSamples*sizeof(int16_t);
211  } else if (datasType == "uint16_t") {
212    uint16_t *data=(uint16_t*)*buf;
213    for (int i = 0; i < nbSamples; i++) {
214      dy[i]=data[i];
215    }
216    *buf += nbSamples*sizeof(uint16_t);
217  } else {
218    printf("UsSensorPlot::DrawDatas type non connu %s\n",datasType.toLocal8Bit().constData());
219  }
220  uint16_t *data=(uint16_t*)*buf;
221  *buf += 4*sizeof(uint16_t);
222 
223  firstPeakStart->setValue( QPointF( data[0], dy[data[0]] ) );
224  firstPeakEnd->setValue( QPointF( data[1], dy[data[1]] ) );
225  secondPeakStart->setValue( QPointF( data[2], dy[data[2]] ) );
226  secondPeakEnd->setValue( QPointF( data[3], dy[data[3]] ) );
227 
228  plot->replot();
229}
230
231
232// context menu
233void UsSensorPlot::mousePressEvent(QMouseEvent *event) {
234  if (event->button() == Qt::RightButton) {
235
236    QMenu *menu = new QMenu("nom", plot);
237    // ajout des actions
238    QAction *a, *z;
239
240    a = menu->addAction("reset zoom");
241    menu->addSeparator();
242
243
244    appendmenu(menu);
245    z = execmenu(plot, menu, event->globalPos());
246    delete menu;
247
248    if (z == a) {
249      // zoom to original size
250      plot->setAxisScale(QwtPlot::yLeft, ymin_orig, ymax_orig);
251      plot->setAxisScale(QwtPlot::xBottom, xmin_orig, xmax_orig);
252    }
253  }
254}
Note: See TracBrowser for help on using the repository browser.