Temporary Connector Reversed Version
Dependencies: UniGraphic mbed vt100
afero_poc15_180403R , J1 のピン配置を反転させたヴァージョンです。
Color2系を使用するためには以下のピンをジャンパで接続してください。
J1-D7 <-> J1-D0
J1-D6 <-> J1-D1
(調査中) また、こちらでテストした範囲では、
FRDM-KL25Z の V3.3 を、Modulo2 の VCC_3V3 ピンに接続してやる必要がありました。
尚、J1-D1, D0 を使用するために UART を無効にしているため
ログは表示されません。
TFTモジュールについて
aitendoのTFTモジュールはデフォルトでは8bit bus モードになっています。
半田のジャンパを変えて、SPIの設定にしてください。
サーミスタについて
POC1.5 では サーミスタは 25℃の時に抵抗値が 50.0kΩになる502AT-11 が
4.95kΩのプルアップ(実際は10kΩx2の並列)で使用されていました。
今回の試作では抵抗値が 10.0kΩの 103AT-11 が
5.1kΩのプルアップで使用されていますので、係数を合わせるために
SMTC502AT-11 のコンストラクタを
R0 = 10.0
R1 = 5.1
B = 3435
T0 = 298.15
で呼ぶように変更しました。
edge_sensor/edge_accel.cpp@1:6c54dc8acf96, 2018-04-24 (annotated)
- Committer:
- Rhyme
- Date:
- Tue Apr 24 12:18:10 2018 +0000
- Revision:
- 1:6c54dc8acf96
- Parent:
- 0:0b6732b53bf4
to adjust with 103AT-11 with 5.1k pull-up, the constructor of 502AT-11 is called with R0=10.0, R1=5.1, B=3435, T0=298.15
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
Rhyme | 0:0b6732b53bf4 | 1 | #include "mbed.h" |
Rhyme | 0:0b6732b53bf4 | 2 | #include "afLib.h" |
Rhyme | 0:0b6732b53bf4 | 3 | #include "edge_reset_mgr.h" |
Rhyme | 0:0b6732b53bf4 | 4 | #include "edge_sensor.h" |
Rhyme | 0:0b6732b53bf4 | 5 | #include "edge_accel.h" |
Rhyme | 0:0b6732b53bf4 | 6 | #include "MMA8451Q.h" |
Rhyme | 0:0b6732b53bf4 | 7 | |
Rhyme | 0:0b6732b53bf4 | 8 | edge_accel::edge_accel(MMA8451Q *accel) : edge_sensor() |
Rhyme | 0:0b6732b53bf4 | 9 | { |
Rhyme | 0:0b6732b53bf4 | 10 | _accel = accel ; |
Rhyme | 0:0b6732b53bf4 | 11 | _sample_count = 0 ; |
Rhyme | 0:0b6732b53bf4 | 12 | _accumulation = 0 ; |
Rhyme | 0:0b6732b53bf4 | 13 | _prev_x = 0 ; |
Rhyme | 0:0b6732b53bf4 | 14 | _prev_y = 0 ; |
Rhyme | 0:0b6732b53bf4 | 15 | _prev_z = 0 ; |
Rhyme | 0:0b6732b53bf4 | 16 | |
Rhyme | 0:0b6732b53bf4 | 17 | _interval = 30 ; |
Rhyme | 0:0b6732b53bf4 | 18 | } |
Rhyme | 0:0b6732b53bf4 | 19 | |
Rhyme | 0:0b6732b53bf4 | 20 | edge_accel::~edge_accel(void) |
Rhyme | 0:0b6732b53bf4 | 21 | { |
Rhyme | 0:0b6732b53bf4 | 22 | delete _accel ; |
Rhyme | 0:0b6732b53bf4 | 23 | } |
Rhyme | 0:0b6732b53bf4 | 24 | |
Rhyme | 0:0b6732b53bf4 | 25 | void edge_accel::reset(void) |
Rhyme | 0:0b6732b53bf4 | 26 | { |
Rhyme | 0:0b6732b53bf4 | 27 | clear_value() ; |
Rhyme | 0:0b6732b53bf4 | 28 | edge_sensor::reset() ; |
Rhyme | 0:0b6732b53bf4 | 29 | } |
Rhyme | 0:0b6732b53bf4 | 30 | |
Rhyme | 0:0b6732b53bf4 | 31 | #if 0 |
Rhyme | 0:0b6732b53bf4 | 32 | void edge_accel::prepare(void) |
Rhyme | 0:0b6732b53bf4 | 33 | { |
Rhyme | 0:0b6732b53bf4 | 34 | // printf("accel prepare\n") ; |
Rhyme | 0:0b6732b53bf4 | 35 | } |
Rhyme | 0:0b6732b53bf4 | 36 | #endif |
Rhyme | 0:0b6732b53bf4 | 37 | |
Rhyme | 0:0b6732b53bf4 | 38 | int edge_accel::sample(void) |
Rhyme | 0:0b6732b53bf4 | 39 | { |
Rhyme | 0:0b6732b53bf4 | 40 | int result ; |
Rhyme | 0:0b6732b53bf4 | 41 | float theValue = 0.0 ; |
Rhyme | 0:0b6732b53bf4 | 42 | if (_sample_count > 1) { /* if sample is 1 or less, no data */ |
Rhyme | 0:0b6732b53bf4 | 43 | _num_sampled = _sample_count - 1 ; |
Rhyme | 0:0b6732b53bf4 | 44 | theValue = (float)_accumulation / (float)(_num_sampled) ; |
Rhyme | 0:0b6732b53bf4 | 45 | result = 0 ; /* success */ |
Rhyme | 0:0b6732b53bf4 | 46 | } else { |
Rhyme | 0:0b6732b53bf4 | 47 | result = 1 ; /* fail! */ |
Rhyme | 0:0b6732b53bf4 | 48 | } |
Rhyme | 0:0b6732b53bf4 | 49 | _value = theValue / 4096.0 ; |
Rhyme | 0:0b6732b53bf4 | 50 | _sampled_time = edge_time ; |
Rhyme | 0:0b6732b53bf4 | 51 | _sample_count = 0 ; |
Rhyme | 0:0b6732b53bf4 | 52 | _accumulation = 0 ; |
Rhyme | 0:0b6732b53bf4 | 53 | return( result ) ; |
Rhyme | 0:0b6732b53bf4 | 54 | } |
Rhyme | 0:0b6732b53bf4 | 55 | |
Rhyme | 0:0b6732b53bf4 | 56 | int edge_accel::deliver(void) |
Rhyme | 0:0b6732b53bf4 | 57 | { |
Rhyme | 0:0b6732b53bf4 | 58 | int result ; |
Rhyme | 0:0b6732b53bf4 | 59 | char timestr[16] ; |
Rhyme | 0:0b6732b53bf4 | 60 | |
Rhyme | 0:0b6732b53bf4 | 61 | print_time(_sampled_time) ; |
Rhyme | 0:0b6732b53bf4 | 62 | // _value = get_value() ; |
Rhyme | 0:0b6732b53bf4 | 63 | printf(" accel: %.3f [%d samples]\n", _value, _num_sampled) ; |
Rhyme | 0:0b6732b53bf4 | 64 | time2seq(_sampled_time, timestr) ; |
Rhyme | 0:0b6732b53bf4 | 65 | sprintf(_str_buf, |
Rhyme | 0:0b6732b53bf4 | 66 | "{\"DEVICE\":\"ACCEL\",\"PN\":\"MMA8451Q\",\"VAL_X\":\"%.3f\",\"VAL_Y\":\"0\",\"VAL_Z\":\"0\",\"UNIT\":\"g\",\"T\":\"%s\",\"E\":\"%d\"}", |
Rhyme | 0:0b6732b53bf4 | 67 | _value, timestr, _error_count) ; |
Rhyme | 0:0b6732b53bf4 | 68 | result = afero->setAttribute(1, _str_buf) ; |
Rhyme | 0:0b6732b53bf4 | 69 | |
Rhyme | 0:0b6732b53bf4 | 70 | return( result == afSUCCESS ) ; |
Rhyme | 0:0b6732b53bf4 | 71 | } |
Rhyme | 0:0b6732b53bf4 | 72 | |
Rhyme | 0:0b6732b53bf4 | 73 | int accel_v2y(float value, edge_chart_type *p) |
Rhyme | 0:0b6732b53bf4 | 74 | { |
Rhyme | 0:0b6732b53bf4 | 75 | int y ; |
Rhyme | 0:0b6732b53bf4 | 76 | if (value < p->min) { |
Rhyme | 0:0b6732b53bf4 | 77 | value = p->min ; |
Rhyme | 0:0b6732b53bf4 | 78 | } else if (value > p->max) { |
Rhyme | 0:0b6732b53bf4 | 79 | value = p->max ; |
Rhyme | 0:0b6732b53bf4 | 80 | } |
Rhyme | 0:0b6732b53bf4 | 81 | y = p->top + p->height/2 - 1 |
Rhyme | 0:0b6732b53bf4 | 82 | - (int)((p->height - 2) * value /(p->max - p->min)) ; |
Rhyme | 0:0b6732b53bf4 | 83 | return( y ) ; |
Rhyme | 0:0b6732b53bf4 | 84 | } |
Rhyme | 0:0b6732b53bf4 | 85 | |
Rhyme | 0:0b6732b53bf4 | 86 | void edge_accel::show(void) |
Rhyme | 0:0b6732b53bf4 | 87 | { |
Rhyme | 0:0b6732b53bf4 | 88 | int x, y ; |
Rhyme | 0:0b6732b53bf4 | 89 | edge_chart_type *p = &edge_chart[0] ; /* edge_chart for accel */ |
Rhyme | 0:0b6732b53bf4 | 90 | reset_watch_dog() ; |
Rhyme | 0:0b6732b53bf4 | 91 | if (display) { |
Rhyme | 0:0b6732b53bf4 | 92 | switch(display_mode) { |
Rhyme | 0:0b6732b53bf4 | 93 | case DISPLAY_MODE_SUMMARY: |
Rhyme | 0:0b6732b53bf4 | 94 | display->BusEnable(true) ; |
Rhyme | 0:0b6732b53bf4 | 95 | display->set_font((unsigned char*) Arial12x12); |
Rhyme | 0:0b6732b53bf4 | 96 | display->set_font_zoom(2, 2) ; |
Rhyme | 0:0b6732b53bf4 | 97 | display->foreground(White) ; |
Rhyme | 0:0b6732b53bf4 | 98 | display->locate(EDGE_SUMMARY_X, EDGE_SUMMARY_TIME_Y) ; |
Rhyme | 0:0b6732b53bf4 | 99 | displayTime(_sampled_time) ; |
Rhyme | 0:0b6732b53bf4 | 100 | // display->locate(10, 5) ; |
Rhyme | 0:0b6732b53bf4 | 101 | // display->printf(timestr) ; |
Rhyme | 0:0b6732b53bf4 | 102 | display->locate(EDGE_SUMMARY_X, EDGE_SUMMARY_ACCEL_Y) ; |
Rhyme | 0:0b6732b53bf4 | 103 | display->printf("Accel: %.3f [%4d]", _value, _num_sampled) ; |
Rhyme | 0:0b6732b53bf4 | 104 | display->BusEnable(false) ; |
Rhyme | 0:0b6732b53bf4 | 105 | reset_watch_dog() ; |
Rhyme | 0:0b6732b53bf4 | 106 | break ; |
Rhyme | 0:0b6732b53bf4 | 107 | case DISPLAY_MODE_CHART: |
Rhyme | 0:0b6732b53bf4 | 108 | x = p->left + p->index + 1; |
Rhyme | 0:0b6732b53bf4 | 109 | y = accel_v2y(_value, p) ; |
Rhyme | 0:0b6732b53bf4 | 110 | display->BusEnable(true) ; |
Rhyme | 0:0b6732b53bf4 | 111 | if (p->index == 0) { |
Rhyme | 0:0b6732b53bf4 | 112 | draw_chart_frame(p) ; |
Rhyme | 0:0b6732b53bf4 | 113 | } |
Rhyme | 0:0b6732b53bf4 | 114 | display->pixel(x, y, White) ; |
Rhyme | 0:0b6732b53bf4 | 115 | display->BusEnable(false) ; |
Rhyme | 0:0b6732b53bf4 | 116 | p->index = (p->index + 1) % (p->width - 2) ; |
Rhyme | 0:0b6732b53bf4 | 117 | break ; |
Rhyme | 0:0b6732b53bf4 | 118 | default: |
Rhyme | 0:0b6732b53bf4 | 119 | break ; |
Rhyme | 0:0b6732b53bf4 | 120 | } |
Rhyme | 0:0b6732b53bf4 | 121 | } |
Rhyme | 0:0b6732b53bf4 | 122 | clear_value() ; |
Rhyme | 0:0b6732b53bf4 | 123 | reset_watch_dog() ; |
Rhyme | 0:0b6732b53bf4 | 124 | } |
Rhyme | 0:0b6732b53bf4 | 125 | |
Rhyme | 0:0b6732b53bf4 | 126 | int edge_accel::accum(void) |
Rhyme | 0:0b6732b53bf4 | 127 | { |
Rhyme | 0:0b6732b53bf4 | 128 | int result ; |
Rhyme | 0:0b6732b53bf4 | 129 | int16_t value[3] ; |
Rhyme | 0:0b6732b53bf4 | 130 | |
Rhyme | 0:0b6732b53bf4 | 131 | if (_enable) { |
Rhyme | 0:0b6732b53bf4 | 132 | result = _accel->getAllRawData(value) ; |
Rhyme | 0:0b6732b53bf4 | 133 | |
Rhyme | 0:0b6732b53bf4 | 134 | if (result == 0) { /* success */ |
Rhyme | 0:0b6732b53bf4 | 135 | if (_sample_count != 0) { /* first data does not have prev_data */ |
Rhyme | 0:0b6732b53bf4 | 136 | _accumulation += |
Rhyme | 0:0b6732b53bf4 | 137 | abs(_prev_x - value[0]) |
Rhyme | 0:0b6732b53bf4 | 138 | + abs(_prev_y - value[1]) |
Rhyme | 0:0b6732b53bf4 | 139 | + abs(_prev_z - value[2]) ; |
Rhyme | 0:0b6732b53bf4 | 140 | } |
Rhyme | 0:0b6732b53bf4 | 141 | |
Rhyme | 0:0b6732b53bf4 | 142 | _sample_count++ ; |
Rhyme | 0:0b6732b53bf4 | 143 | |
Rhyme | 0:0b6732b53bf4 | 144 | _prev_x = value[0] ; |
Rhyme | 0:0b6732b53bf4 | 145 | _prev_y = value[1] ; |
Rhyme | 0:0b6732b53bf4 | 146 | _prev_z = value[2] ; |
Rhyme | 0:0b6732b53bf4 | 147 | } |
Rhyme | 0:0b6732b53bf4 | 148 | } |
Rhyme | 0:0b6732b53bf4 | 149 | |
Rhyme | 0:0b6732b53bf4 | 150 | return( result ) ; |
Rhyme | 0:0b6732b53bf4 | 151 | } |
Rhyme | 0:0b6732b53bf4 | 152 | |
Rhyme | 0:0b6732b53bf4 | 153 | void edge_accel::clear_value(void) |
Rhyme | 0:0b6732b53bf4 | 154 | { |
Rhyme | 0:0b6732b53bf4 | 155 | _sample_count = 0 ; |
Rhyme | 0:0b6732b53bf4 | 156 | _accumulation = 0 ; |
Rhyme | 0:0b6732b53bf4 | 157 | _prev_x = 0 ; |
Rhyme | 0:0b6732b53bf4 | 158 | _prev_y = 0 ; |
Rhyme | 0:0b6732b53bf4 | 159 | _prev_z = 0 ; |
Rhyme | 0:0b6732b53bf4 | 160 | } |
Rhyme | 0:0b6732b53bf4 | 161 | |
Rhyme | 0:0b6732b53bf4 | 162 | |
Rhyme | 0:0b6732b53bf4 | 163 |