La Suno / Mbed 2 deprecated afero_poc15_180216

Gas Pressure Display Updated Power control for Pressure sensor added

Dependencies:   UniGraphic mbed vt100

edge_sensor/edge_accel.cpp@0:37c8ecde13c2, 2018-02-16 (annotated)

Committer:
Rhyme
Date:
Fri Feb 16 08:27:50 2018 +0000
Revision:
0:37c8ecde13c2
control PSE530 power via PTC5 (pse530_en)

Who changed what in which revision?

UserRevisionLine numberNew contents of line
Rhyme 0:37c8ecde13c2 1 #include "mbed.h"
Rhyme 0:37c8ecde13c2 2 #include "afLib.h"
Rhyme 0:37c8ecde13c2 3 #include "edge_reset_mgr.h"
Rhyme 0:37c8ecde13c2 4 #include "edge_sensor.h"
Rhyme 0:37c8ecde13c2 5 #include "edge_accel.h"
Rhyme 0:37c8ecde13c2 6 #include "MMA8451Q.h"
Rhyme 0:37c8ecde13c2 7
Rhyme 0:37c8ecde13c2 8 edge_accel::edge_accel(MMA8451Q *accel) : edge_sensor()
Rhyme 0:37c8ecde13c2 9 {
Rhyme 0:37c8ecde13c2 10 _accel = accel ;
Rhyme 0:37c8ecde13c2 11 _sample_count = 0 ;
Rhyme 0:37c8ecde13c2 12 _accumulation = 0 ;
Rhyme 0:37c8ecde13c2 13 _prev_x = 0 ;
Rhyme 0:37c8ecde13c2 14 _prev_y = 0 ;
Rhyme 0:37c8ecde13c2 15 _prev_z = 0 ;
Rhyme 0:37c8ecde13c2 16
Rhyme 0:37c8ecde13c2 17 _interval = 30 ;
Rhyme 0:37c8ecde13c2 18 }
Rhyme 0:37c8ecde13c2 19
Rhyme 0:37c8ecde13c2 20 edge_accel::~edge_accel(void)
Rhyme 0:37c8ecde13c2 21 {
Rhyme 0:37c8ecde13c2 22 delete _accel ;
Rhyme 0:37c8ecde13c2 23 }
Rhyme 0:37c8ecde13c2 24
Rhyme 0:37c8ecde13c2 25 void edge_accel::reset(void)
Rhyme 0:37c8ecde13c2 26 {
Rhyme 0:37c8ecde13c2 27 clear_value() ;
Rhyme 0:37c8ecde13c2 28 edge_sensor::reset() ;
Rhyme 0:37c8ecde13c2 29 }
Rhyme 0:37c8ecde13c2 30
Rhyme 0:37c8ecde13c2 31 #if 0
Rhyme 0:37c8ecde13c2 32 void edge_accel::prepare(void)
Rhyme 0:37c8ecde13c2 33 {
Rhyme 0:37c8ecde13c2 34 // printf("accel prepare\n") ;
Rhyme 0:37c8ecde13c2 35 }
Rhyme 0:37c8ecde13c2 36 #endif
Rhyme 0:37c8ecde13c2 37
Rhyme 0:37c8ecde13c2 38 int edge_accel::sample(void)
Rhyme 0:37c8ecde13c2 39 {
Rhyme 0:37c8ecde13c2 40 int result ;
Rhyme 0:37c8ecde13c2 41 float theValue = 0.0 ;
Rhyme 0:37c8ecde13c2 42 if (_sample_count > 1) { /* if sample is 1 or less, no data */
Rhyme 0:37c8ecde13c2 43 _num_sampled = _sample_count - 1 ;
Rhyme 0:37c8ecde13c2 44 theValue = (float)_accumulation / (float)(_num_sampled) ;
Rhyme 0:37c8ecde13c2 45 result = 0 ; /* success */
Rhyme 0:37c8ecde13c2 46 } else {
Rhyme 0:37c8ecde13c2 47 result = 1 ; /* fail! */
Rhyme 0:37c8ecde13c2 48 }
Rhyme 0:37c8ecde13c2 49 _value = theValue / 4096.0 ;
Rhyme 0:37c8ecde13c2 50 _sampled_time = edge_time ;
Rhyme 0:37c8ecde13c2 51 _sample_count = 0 ;
Rhyme 0:37c8ecde13c2 52 _accumulation = 0 ;
Rhyme 0:37c8ecde13c2 53 return( result ) ;
Rhyme 0:37c8ecde13c2 54 }
Rhyme 0:37c8ecde13c2 55
Rhyme 0:37c8ecde13c2 56 int edge_accel::deliver(void)
Rhyme 0:37c8ecde13c2 57 {
Rhyme 0:37c8ecde13c2 58 int result ;
Rhyme 0:37c8ecde13c2 59 char timestr[16] ;
Rhyme 0:37c8ecde13c2 60
Rhyme 0:37c8ecde13c2 61 print_time(_sampled_time) ;
Rhyme 0:37c8ecde13c2 62 // _value = get_value() ;
Rhyme 0:37c8ecde13c2 63 printf(" accel: %.3f [%d samples]\n", _value, _num_sampled) ;
Rhyme 0:37c8ecde13c2 64 time2seq(_sampled_time, timestr) ;
Rhyme 0:37c8ecde13c2 65 sprintf(_str_buf,
Rhyme 0:37c8ecde13c2 66 "{\"DEVICE\":\"ACCEL\",\"PN\":\"MMA8451Q\",\"VAL_X\":\"%.3f\",\"VAL_Y\":\"0\",\"VAL_Z\":\"0\",\"UNIT\":\"g\",\"T\":\"%s\",\"E\":\"%d\"}",
Rhyme 0:37c8ecde13c2 67 _value, timestr, _error_count) ;
Rhyme 0:37c8ecde13c2 68 result = afero->setAttribute(1, _str_buf) ;
Rhyme 0:37c8ecde13c2 69
Rhyme 0:37c8ecde13c2 70 return( result == afSUCCESS ) ;
Rhyme 0:37c8ecde13c2 71 }
Rhyme 0:37c8ecde13c2 72
Rhyme 0:37c8ecde13c2 73 int accel_v2y(float value, edge_chart_type *p)
Rhyme 0:37c8ecde13c2 74 {
Rhyme 0:37c8ecde13c2 75 int y ;
Rhyme 0:37c8ecde13c2 76 if (value < p->min) {
Rhyme 0:37c8ecde13c2 77 value = p->min ;
Rhyme 0:37c8ecde13c2 78 } else if (value > p->max) {
Rhyme 0:37c8ecde13c2 79 value = p->max ;
Rhyme 0:37c8ecde13c2 80 }
Rhyme 0:37c8ecde13c2 81 y = p->top + p->height/2 - 1
Rhyme 0:37c8ecde13c2 82 - (int)((p->height - 2) * value /(p->max - p->min)) ;
Rhyme 0:37c8ecde13c2 83 return( y ) ;
Rhyme 0:37c8ecde13c2 84 }
Rhyme 0:37c8ecde13c2 85
Rhyme 0:37c8ecde13c2 86 void edge_accel::show(void)
Rhyme 0:37c8ecde13c2 87 {
Rhyme 0:37c8ecde13c2 88 int x, y ;
Rhyme 0:37c8ecde13c2 89 edge_chart_type *p = &edge_chart[0] ; /* edge_chart for accel */
Rhyme 0:37c8ecde13c2 90 reset_watch_dog() ;
Rhyme 0:37c8ecde13c2 91 if (display) {
Rhyme 0:37c8ecde13c2 92 switch(display_mode) {
Rhyme 0:37c8ecde13c2 93 case DISPLAY_MODE_SUMMARY:
Rhyme 0:37c8ecde13c2 94 display->BusEnable(true) ;
Rhyme 0:37c8ecde13c2 95 display->set_font((unsigned char*) Arial12x12);
Rhyme 0:37c8ecde13c2 96 display->set_font_zoom(2, 2) ;
Rhyme 0:37c8ecde13c2 97 display->foreground(White) ;
Rhyme 0:37c8ecde13c2 98 display->locate(EDGE_SUMMARY_X, EDGE_SUMMARY_TIME_Y) ;
Rhyme 0:37c8ecde13c2 99 displayTime(_sampled_time) ;
Rhyme 0:37c8ecde13c2 100 // display->locate(10, 5) ;
Rhyme 0:37c8ecde13c2 101 // display->printf(timestr) ;
Rhyme 0:37c8ecde13c2 102 display->locate(EDGE_SUMMARY_X, EDGE_SUMMARY_ACCEL_Y) ;
Rhyme 0:37c8ecde13c2 103 display->printf("Accel: %.3f [%4d]", _value, _num_sampled) ;
Rhyme 0:37c8ecde13c2 104 display->BusEnable(false) ;
Rhyme 0:37c8ecde13c2 105 reset_watch_dog() ;
Rhyme 0:37c8ecde13c2 106 break ;
Rhyme 0:37c8ecde13c2 107 case DISPLAY_MODE_CHART:
Rhyme 0:37c8ecde13c2 108 x = p->left + p->index + 1;
Rhyme 0:37c8ecde13c2 109 y = accel_v2y(_value, p) ;
Rhyme 0:37c8ecde13c2 110 display->BusEnable(true) ;
Rhyme 0:37c8ecde13c2 111 if (p->index == 0) {
Rhyme 0:37c8ecde13c2 112 draw_chart_frame(p) ;
Rhyme 0:37c8ecde13c2 113 }
Rhyme 0:37c8ecde13c2 114 display->pixel(x, y, White) ;
Rhyme 0:37c8ecde13c2 115 display->BusEnable(false) ;
Rhyme 0:37c8ecde13c2 116 p->index = (p->index + 1) % (p->width - 2) ;
Rhyme 0:37c8ecde13c2 117 break ;
Rhyme 0:37c8ecde13c2 118 default:
Rhyme 0:37c8ecde13c2 119 break ;
Rhyme 0:37c8ecde13c2 120 }
Rhyme 0:37c8ecde13c2 121 }
Rhyme 0:37c8ecde13c2 122 clear_value() ;
Rhyme 0:37c8ecde13c2 123 reset_watch_dog() ;
Rhyme 0:37c8ecde13c2 124 }
Rhyme 0:37c8ecde13c2 125
Rhyme 0:37c8ecde13c2 126 int edge_accel::accum(void)
Rhyme 0:37c8ecde13c2 127 {
Rhyme 0:37c8ecde13c2 128 int result ;
Rhyme 0:37c8ecde13c2 129 int16_t value[3] ;
Rhyme 0:37c8ecde13c2 130
Rhyme 0:37c8ecde13c2 131 if (_enable) {
Rhyme 0:37c8ecde13c2 132 result = _accel->getAllRawData(value) ;
Rhyme 0:37c8ecde13c2 133
Rhyme 0:37c8ecde13c2 134 if (result == 0) { /* success */
Rhyme 0:37c8ecde13c2 135 if (_sample_count != 0) { /* first data does not have prev_data */
Rhyme 0:37c8ecde13c2 136 _accumulation +=
Rhyme 0:37c8ecde13c2 137 abs(_prev_x - value[0])
Rhyme 0:37c8ecde13c2 138 + abs(_prev_y - value[1])
Rhyme 0:37c8ecde13c2 139 + abs(_prev_z - value[2]) ;
Rhyme 0:37c8ecde13c2 140 }
Rhyme 0:37c8ecde13c2 141
Rhyme 0:37c8ecde13c2 142 _sample_count++ ;
Rhyme 0:37c8ecde13c2 143
Rhyme 0:37c8ecde13c2 144 _prev_x = value[0] ;
Rhyme 0:37c8ecde13c2 145 _prev_y = value[1] ;
Rhyme 0:37c8ecde13c2 146 _prev_z = value[2] ;
Rhyme 0:37c8ecde13c2 147 }
Rhyme 0:37c8ecde13c2 148 }
Rhyme 0:37c8ecde13c2 149
Rhyme 0:37c8ecde13c2 150 return( result ) ;
Rhyme 0:37c8ecde13c2 151 }
Rhyme 0:37c8ecde13c2 152
Rhyme 0:37c8ecde13c2 153 void edge_accel::clear_value(void)
Rhyme 0:37c8ecde13c2 154 {
Rhyme 0:37c8ecde13c2 155 _sample_count = 0 ;
Rhyme 0:37c8ecde13c2 156 _accumulation = 0 ;
Rhyme 0:37c8ecde13c2 157 _prev_x = 0 ;
Rhyme 0:37c8ecde13c2 158 _prev_y = 0 ;
Rhyme 0:37c8ecde13c2 159 _prev_z = 0 ;
Rhyme 0:37c8ecde13c2 160 }
Rhyme 0:37c8ecde13c2 161
Rhyme 0:37c8ecde13c2 162
Rhyme 0:37c8ecde13c2 163