source: asp3_tinet_ecnl_rx/trunk/app3_human_detec/src/echonet_main.c@ 344

Last change on this file since 344 was 344, checked in by coas-nagasima, 5 years ago

検知レベルとアナログ値の高低を反転

  • Property svn:eol-style set to native
  • Property svn:mime-type set to text/x-csrc;charset=UTF-8
File size: 15.6 KB
Line 
1/*
2 * TOPPERS ECHONET Lite Communication Middleware
3 *
4 * Copyright (C) 2014-2018 Cores Co., Ltd. Japan
5 *
6 * 上記著作権者は,以下の(1)~(4)の条件を満たす場合に限り,本ソフトウェ
7 * ア(本ソフトウェアを改変したものを含む.以下同じ)を使用・複製・改
8 * 変・再配布(以下,利用と呼ぶ)することを無償で許諾する.
9 * (1) 本ソフトウェアをソースコードの形で利用する場合には,上記の著作
10 * 権表示,この利用条件および下記の無保証規定が,そのままの形でソー
11 * スコード中に含まれていること.
12 * (2) 本ソフトウェアを,ライブラリ形式など,他のソフトウェア開発に使
13 * 用できる形で再配布する場合には,再配布に伴うドキュメント(利用
14 * 者マニュアルなど)に,上記の著作権表示,この利用条件および下記
15 * の無保証規定を掲載すること.
16 * (3) 本ソフトウェアを,機器に組み込むなど,他のソフトウェア開発に使
17 * 用できない形で再配布する場合には,次のいずれかの条件を満たすこ
18 * と.
19 * (a) 再配布に伴うドキュメント(利用者マニュアルなど)に,上記の著
20 * 作権表示,この利用条件および下記の無保証規定を掲載すること.
21 * (b) 再配布の形態を,別に定める方法によって,TOPPERSプロジェクトに
22 * 報告すること.
23 * (4) 本ソフトウェアの利用により直接的または間接的に生じるいかなる損
24 * 害からも,上記著作権者およびTOPPERSプロジェクトを免責すること.
25 * また,本ソフトウェアのユーザまたはエンドユーザからのいかなる理
26 * 由に基づく請求からも,上記著作権者およびTOPPERSプロジェクトを
27 * 免責すること.
28 *
29 * 本ソフトウェアは,無保証で提供されているものである.上記著作権者お
30 * よびTOPPERSプロジェクトは,本ソフトウェアに関して,特定の使用目的
31 * に対する適合性も含めて,いかなる保証も行わない.また,本ソフトウェ
32 * アの利用により直接的または間接的に生じたいかなる損害に関しても,そ
33 * の責任を負わない.
34 *
35 * @(#) $Id$
36 */
37
38/*
39 * サンプルプログラム(1)の本体
40 */
41
42#include <kernel.h>
43#include <t_syslog.h>
44#include <t_stdlib.h>
45#include <sil.h>
46#include <string.h>
47#include "syssvc/serial.h"
48#include "syssvc/syslog.h"
49#include "kernel_cfg.h"
50#include "echonet_main.h"
51#include "echonet_cfg.h"
52#include "target_kernel_impl.h"
53
54/* TODO: メーカーコードを設定 */
55#define MAKER_CODE { 0x00, 0x00, 0xB3 } /* TOPPERSプロジェクト */
56
57/* ノードプロファイルオブジェクト */
58struct ecn_cls0EF0_t node_profile_data = {
59 0x30, /* 動作状態 */
60 { 0x01, 0x0A, { 0x01, 0x00 } }, /* Version情報 */
61 {
62 0xFE, /* 下位通信層IDフィールド */
63 { MAKER_CODE }, /* メーカーコード */
64 { 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, }, /* ユニークID部(メーカー独自) */
65 },
66 0x0000, /* 異常内容 */
67 { MAKER_CODE }, /* メーカーコード */
68};
69
70/* 人体検知センサクラス */
71struct ecn_cls0007_t human_detection_sensor_data = {
72 0x30, /* 動作状態 */
73 0x35, /* 検知閾値レベル設定(初期値として1~4が未検出、初期値として4~8が検出) */
74 0x31, /* 検知レベル状態(人体検知状態用)*/
75 0x00, /* 設置場所 */
76 { 0x00, 0x00, 'C', 0x00 }, /* 規格Version情報 */
77 0x42, /* 異常発生状態 */
78 { MAKER_CODE }, /* メーカーコード */
79};
80
81/*
82 * 動作状態ON/OFF設定関数(0x30, 0x31のみ受け付け)
83 */
84int onoff_prop_set(const EPRPINIB *item, const void *src, int size, bool_t *anno)
85{
86 /* サイズが1以外は受け付けない */
87 if(size != 1)
88 return 0;
89
90 *anno = *((uint8_t *)item->exinf) != *((uint8_t *)src);
91
92 switch(*(uint8_t *)src){
93 /* ONの場合 */
94 case 0x30:
95 *((uint8_t *)item->exinf) = *((uint8_t *)src);
96 /* LEDの"."をON */
97 sil_wrb_mem((uint8_t *)0x0008C02A, sil_reb_mem((uint8_t *)0x0008C02A) | 0x40);
98 break;
99 /* OFFの場合 */
100 case 0x31:
101 *((uint8_t *)item->exinf) = *((uint8_t *)src);
102 /* LEDの"."をOFF */
103 sil_wrb_mem((uint8_t *)0x0008C02A, sil_reb_mem((uint8_t *)0x0008C02A) & ~0x40);
104 break;
105 /* 0x30か0x31以外は受け付けない */
106 default:
107 return 0;
108 }
109
110 return 1;
111}
112
113/*
114 * 異常発生状態設定関数(0x41, 0x42のみ受け付け)
115 */
116int alarm_prop_set(const EPRPINIB *item, const void *src, int size, bool_t *anno)
117{
118 /* サイズが1以外は受け付けない */
119 if(size != 1)
120 return 0;
121
122 *anno = *((uint8_t *)item->exinf) != *((uint8_t *)src);
123
124 switch(*(uint8_t *)src){
125 /* 異常発生ありの場合 */
126 case 0x41:
127 /* 異常発生なしの場合 */
128 case 0x42:
129 *((uint8_t *)item->exinf) = *((uint8_t *)src);
130 break;
131 /* 0x41か0x42以外は受け付けない */
132 default:
133 return 0;
134 }
135
136 return 1;
137}
138
139/*
140 * 検知閾値レベル設定設定関数
141 */
142int detection_threshold_set(const EPRPINIB *item, const void *src, int size, bool_t *anno)
143{
144 /* サイズが1以外は受け付けない */
145 if(size != 1)
146 return 0;
147
148 if((*(uint8_t *)src >= 0x31) && (*(uint8_t *)src <= 0x38)){
149 *((uint8_t *)item->exinf) = *((uint8_t *)src);
150 }
151 /* 上記以外は受け付けない */
152 else{
153 return 0;
154 }
155
156 return 1;
157}
158
159uint8_t led_disp[] = { 0x00, 0x00, 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07 };
160
161/*
162 * 検知レベル設定関数
163 */
164int detection_state_set(const EPRPINIB *item, const void *src, int size, bool_t *anno)
165{
166 struct ecn_cls0007_t *eobj = (struct ecn_cls0007_t *)item->exinf;
167 ER ret;
168 T_EDATA *esv;
169 uint8_t prev_state;
170 uint8_t sseg = sil_reb_mem((uint8_t *)0x0008C02A) & ~0x07;
171
172 /* サイズが1以外は受け付けない */
173 if(size != 1)
174 return 0;
175
176 *anno = false;
177
178 if((*(uint8_t *)src >= 0x31) && (*(uint8_t *)src <= 0x38)){
179 /* 以前の検知レベルを保存 */
180 prev_state = eobj->state;
181 /* 検知レベル設定 */
182 eobj->state = *((uint8_t *)src);
183 /* LEDに検知レベルを表示 */
184 sil_wrb_mem((uint8_t *)0x0008C02A, sseg | led_disp[eobj->state - 0x30]);
185
186 /* 人体検知状態に変化があった場合 */
187 if((prev_state < eobj->threshold) != (eobj->state < eobj->threshold))
188 {
189 /* プロパティ通知 */
190 *anno = true;
191 }
192 }
193 /* 上記以外は受け付けない */
194 else{
195 return 0;
196 }
197
198 return 1;
199}
200
201/*
202 * 人体検知状態取得関数
203 */
204int detection_state_get(const EPRPINIB *item, void *dst, int size)
205{
206 struct ecn_cls0007_t *eobj = (struct ecn_cls0007_t *)item->exinf;
207
208 /* 閾値より検知レベルが低い場合 */
209 if(eobj->state < eobj->threshold){
210 /* 人体検知なし */
211 ((uint8_t *)dst)[0] = 0x42;
212 }
213 /* 閾値より検知レベルが高い場合 */
214 else{
215 /* 人体検知あり */
216 ((uint8_t *)dst)[0] = 0x41;
217 }
218
219 return 1;
220}
221
222static void main_initialize();
223static int main_get_timer();
224static void main_progress(int interval);
225static void main_recv_esv(T_EDATA *esv);
226static void main_break_wait(uint8_t *brkdat, int32_t len);
227static void main_timeout();
228
229/*
230 * メインタスク
231 */
232void echonet_main_task(intptr_t exinf)
233{
234 ER ret, ret2;
235 SYSTIM prev, now;
236 int timer;
237 T_EDATA *esv;
238 uint8_t brkdat[64];
239 int32_t len;
240
241 /* アプリケーションの初期化 */
242 main_initialize();
243
244 ret2 = get_tim(&now);
245 if (ret2 != E_OK){
246 syslog(LOG_ERROR, "get_tim");
247 return;
248 }
249
250 for(;;){
251 prev = now;
252
253 /* タイマー取得 */
254 timer = main_get_timer();
255
256 /* 応答電文待ち */
257 ret = ecn_trcv_esv(&esv, timer);
258 if ((ret != E_OK) && (ret != E_BRK) && (ret != E_TMOUT)){
259 syslog(LOG_ERROR, "ecn_trcv_esv");
260 break;
261 }
262
263 ret2 = get_tim(&now);
264 if (ret2 != E_OK){
265 syslog(LOG_ERROR, "get_tim");
266 break;
267 }
268
269 /* 時間経過 */
270 main_progress(now - prev);
271
272 /* Echonet電文受信の場合 */
273 if (ret == E_OK) {
274 /* Echonet電文受信処理 */
275 main_recv_esv(esv);
276
277 /* 領域解放 */
278 ret = ecn_rel_esv(esv);
279 if (ret != E_OK){
280 syslog(LOG_ERROR, "ecn_rel_esv");
281 break;
282 }
283 }
284 /* 応答電文待ちの割り込みの場合 */
285 else if (ret == E_BRK) {
286 /* 応答電文待ちの割り込みデータ取得 */
287 ret = ecn_get_brk_dat(esv, brkdat, sizeof(brkdat), &len);
288 if (ret != E_OK){
289 syslog(LOG_ERROR, "ecn_get_brk_dat");
290 break;
291 }
292
293 /* 応答電文待ちの割り込み処理 */
294 main_break_wait(brkdat, len);
295
296 /* 領域解放 */
297 ret = ecn_rel_esv(esv);
298 if (ret != E_OK){
299 syslog(LOG_ERROR, "ecn_rel_esv");
300 break;
301 }
302 }
303
304 /* タイムアウト処理 */
305 main_timeout();
306 }
307}
308
309bool_t started = false;
310
311void echonet_change_netif_link(uint8_t link_up, uint8_t up)
312{
313 ER ret;
314
315 if (link_up == 0)
316 return;
317
318 if (up && !started) {
319 started = true;
320
321 /* ECHONETミドルウェアを起動 */
322 ret = ecn_sta_svc();
323 if (ret != E_OK)
324 return;
325 }
326
327 /* メインタスクに通知 */
328 uint8_t data[2];
329 data[0] = 0x01;
330 data[1] = up ? 0x01 : 0x02;
331 ret = ecn_brk_wai(data, sizeof(data));
332 if (ret != E_OK) {
333 syslog(LOG_ERROR, "ecn_brk_wai");
334 return;
335 }
336}
337
338enum main_state_t{
339 main_state_idle,
340};
341
342int main_timer = TMO_FEVR;
343enum main_state_t main_state = main_state_idle;
344bool_t main_btn1_state;
345int main_btn1_count = 0;
346bool_t main_btn2_state;
347int main_btn2_count = 0;
348
349/*
350 * 初期化
351 */
352static void main_initialize()
353{
354 uint8_t btn1, btn2;
355
356 /*
357 * モジュールストップ機能の設定(S12AD)
358 */
359 sil_wrh_mem((uint16_t *)SYSTEM_PRCR_ADDR, (uint16_t)0xA502); /* 書込み許可 */
360 sil_wrw_mem((uint32_t *)SYSTEM_MSTPCRA_ADDR,
361 sil_rew_mem((uint32_t *)SYSTEM_MSTPCRA_ADDR) & ~SYSTEM_MSTPCRA_MSTPA17_BIT);
362 sil_wrh_mem((uint16_t *)SYSTEM_PRCR_ADDR, (uint16_t)0xA500); /* 書込み禁止 */
363
364 /* LEDを"0000"と表示 */
365 sil_wrb_mem((uint8_t *)0x0008C02A, 0x00);
366
367 /* 10ms後にボタン状態を確認 */
368 main_timer = 10 * 1000;
369
370 /* 12bitADC初期化 */
371 sil_wrh_mem((uint16_t *)S12AD_ADEXICR_ADDR, 0x0000); /* 温度センサ出力、内部基準電圧非選択 */
372 sil_wrh_mem((uint16_t *)S12AD_ADANS0_ADDR, 0x0001); /* 変換ポートAN000選択、AN001~AN015非選択 */
373 sil_wrh_mem((uint16_t *)S12AD_ADANS1_ADDR, 0x0000); /* 変換ポートAN016~AN020非選択 */
374
375 /* ボタン状態読み込み */
376 btn1 = sil_reb_mem((uint8_t *)0x0008C04A);
377 btn2 = sil_reb_mem((uint8_t *)0x0008C040);
378 main_btn1_state = (btn1 & 0x80) != 0;
379 main_btn2_state = (btn2 & 0x80) != 0;
380
381 ER ret = act_tsk(MAIN_TASK);
382 if (ret != E_OK) {
383 syslog(LOG_ERROR, "act_tsk");
384 }
385}
386
387/*
388 * タイマー取得
389 */
390static int main_get_timer()
391{
392 return main_timer;
393}
394
395/*
396 * 時間経過
397 */
398static void main_progress(int interval)
399{
400 if(main_timer == TMO_FEVR)
401 return;
402
403 main_timer -= interval;
404 if(main_timer < 0){
405 main_timer = 0;
406 }
407}
408
409/*
410 * Echonet電文受信処理
411 */
412static void main_recv_esv(T_EDATA *esv)
413{
414 ER ret;
415 uint8_t epc;
416 uint8_t pdc;
417 uint8_t p_edt[256];
418 T_ENUM_EPC enm;
419
420 ret = ecn_itr_ini(&enm, esv);
421 if(ret != E_OK){
422 syslog(LOG_ERROR, "ecn_itr_ini");
423 return;
424 }
425
426 for(;;) {
427 while((ret = ecn_itr_nxt(&enm, &epc, &pdc, p_edt)) == E_OK) {
428 switch (epc) {
429 case 0x80:
430 break;
431 case 0x81:
432 break;
433 }
434 }
435 if(ret != E_BOVR){
436 syslog(LOG_ERROR, "ecn_itr_nxt");
437 break;
438 }
439 if(enm.is_eof)
440 break;
441 }
442}
443
444/*
445 * 応答電文待ちの割り込み処理
446 */
447static void main_break_wait(uint8_t *brkdat, int32_t len)
448{
449 switch(main_state){
450 case main_state_idle:
451 break;
452 }
453}
454
455static uint8_t main_ad_level = 1;
456static uint16_t main_ad_table[64];
457#define main_ad_table_count (sizeof(main_ad_table) / sizeof(main_ad_table[0]))
458static int main_ad_pos = 0;
459static uint32_t main_ad_avelage;
460static int main_count;
461
462static void main_ad_change();
463static void main_btn1_change(bool_t push);
464static void main_btn2_change(bool_t push);
465
466/*
467 * タイムアウト処理
468 */
469static void main_timeout()
470{
471 uint8_t btn1, btn2;
472 uint16_t ad_value;
473 uint8_t ad_level;
474
475 if(main_timer != 0)
476 return;
477
478 switch(main_state){
479 case main_state_idle:
480 /* 10ms後にボタン状態を確認 */
481 main_timer = 10 * 1000;
482
483 /* ADCの変換結果取得 */
484 if((sil_reb_mem((uint8_t *)S12AD_ADCSR_ADDR) & S12AD_ADCSR_ADST_BIT) == 0){
485 main_ad_avelage -= main_ad_table[main_ad_pos];
486 ad_value = sil_reh_mem((uint16_t *)S12AD_ADDR0_ADDR);
487 main_ad_table[main_ad_pos] = ad_value;
488 main_ad_avelage += ad_value;
489
490 main_ad_pos++;
491 if(main_ad_pos >= main_ad_table_count){
492 main_ad_pos = 0;
493 }
494
495 ad_level = (((main_ad_avelage / main_ad_table_count) >> 9) & 0x7) + 1;
496 if(main_ad_level != ad_level){
497 /* 1秒変化が続いたら */
498 if(main_count < 100){
499 main_count++;
500 }
501 else{
502 main_ad_level = ad_level;
503
504 /* ADC状態変化処理 */
505 main_ad_change();
506 }
507 }
508 else{
509 main_count = 0;
510 }
511
512 /* 変換開始(シングルスキャンモード) */
513 sil_wrb_mem((uint8_t *)S12AD_ADCSR_ADDR, S12AD_ADCSR_ADST_BIT);
514 }
515
516 /* ボタン状態読み込み */
517 btn1 = sil_reb_mem((uint8_t *) 0x0008C04A);
518 btn2 = sil_reb_mem((uint8_t *) 0x0008C040);
519
520 /* ボタン1の処理 */
521 if(((btn1 & 0x80) != 0) && !main_btn1_state){
522 main_btn1_count++;
523 if(main_btn1_count > 10){
524 main_btn1_count = 0;
525 main_btn1_state = true;
526
527 main_btn1_change(true);
528 }
529 }
530 else if(((btn1 & 0x80) == 0) && main_btn1_state){
531 main_btn1_count++;
532 if(main_btn1_count > 10){
533 main_btn1_count = 0;
534 main_btn1_state = false;
535
536 main_btn1_change(false);
537 }
538 }
539
540 /* ボタン2の処理 */
541 if(((btn2 & 0x80) != 0) && !main_btn2_state){
542 main_btn2_count++;
543 if(main_btn2_count > 10){
544 main_btn2_count = 0;
545 main_btn2_state = true;
546
547 main_btn2_change(true);
548 }
549 }
550 else if(((btn2 & 0x80) == 0) && main_btn2_state){
551 main_btn2_count++;
552 if(main_btn2_count > 10){
553 main_btn2_count = 0;
554 main_btn2_state = false;
555
556 main_btn2_change(false);
557 }
558 }
559 break;
560 }
561}
562
563/*
564 * ADC状態変化処理
565 */
566static void main_ad_change()
567{
568 ER ret;
569 T_EDATA *esv;
570 uint8_t p_edt[1];
571
572 p_edt[0] = 0x30 + main_ad_level;
573
574 /* プロパティ設定電文作成 */
575 ret = ecn_esv_setc(&esv, HUMAN_DETECTION_SENSOR_EOBJ, 0xB1, 1, p_edt);
576 if(ret != E_OK){
577 syslog(LOG_ERROR, "ecn_esv_setc");
578 return;
579 }
580
581 /* 電文送信 */
582 ecn_snd_esv(esv);
583}
584
585uint8_t main_level = 1;
586bool_t main_rev = false;
587
588/*
589 * ボタン1状態変化処理
590 */
591static void main_btn1_change(bool_t push)
592{
593 ER ret;
594 T_EDATA *esv;
595 uint8_t p_edt[1];
596
597 /* 押されて戻った時に処理する */
598 if(push)
599 return;
600
601 /* 人体検知状態 */
602 if(!main_rev){
603 main_level--;
604 if(main_level < 1){
605 main_level = 1;
606 main_rev = true;
607 }
608 }
609 else{
610 main_level++;
611 if(main_level > 8){
612 main_level = 8;
613 main_rev = false;
614 }
615 }
616
617 p_edt[0] = 0x30 + main_level;
618
619 /* プロパティ設定電文作成 */
620 ret = ecn_esv_setc(&esv, HUMAN_DETECTION_SENSOR_EOBJ, 0xB1, 1, p_edt);
621 if(ret != E_OK){
622 syslog(LOG_ERROR, "ecn_esv_setc");
623 return;
624 }
625
626 /* 電文送信 */
627 ecn_snd_esv(esv);
628}
629
630/*
631 * ボタン2状態変化処理
632 */
633static void main_btn2_change(bool_t push)
634{
635 ER ret;
636 T_EDATA *esv;
637 uint8_t p_edt[1];
638
639 /* 押されて戻った時に処理する */
640 if(push)
641 return;
642
643 /* 人体検知状態 */
644 if(!main_rev){
645 main_level++;
646 if(main_level > 8){
647 main_level = 8;
648 main_rev = false;
649 }
650 }
651 else{
652 main_level--;
653 if(main_level < 1){
654 main_level = 1;
655 main_rev = true;
656 }
657 }
658
659 p_edt[0] = 0x30 + main_level;
660
661 /* プロパティ設定電文作成 */
662 ret = ecn_esv_setc(&esv, HUMAN_DETECTION_SENSOR_EOBJ, 0xB1, 1, p_edt);
663 if(ret != E_OK){
664 syslog(LOG_ERROR, "ecn_esv_setc");
665 return;
666 }
667
668 /* 電文送信 */
669 ecn_snd_esv(esv);
670}
Note: See TracBrowser for help on using the repository browser.