source: asp3_tinet_ecnl_rx/trunk/app7_buzzer/src/echonet_main.c@ 351

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

ECHONETミドルウェアを起動後、少し待つよう変更。

  • Property svn:eol-style set to native
  • Property svn:mime-type set to text/x-csrc;charset=UTF-8
File size: 13.9 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_local_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 { MAKER_CODE }, /* メーカーコード */
67};
68
69/* 電気ポットクラス */
70struct ecn_cls03B2_t electric_hot_water_pot_data = {
71 0x30, /* 動作状態 */
72 0x41, /* 湯切れ警告状態 */
73 0x41, /* 出湯状態 */
74 0x00, /* 設置場所 */
75 { 0x00, 0x00, 'C', 0x00 }, /* 規格Version情報 */
76 0x42, /* 異常発生状態 */
77 { MAKER_CODE }, /* メーカーコード */
78};
79
80/* ノードプロファイルオブジェクト */
81struct ecn_cls0EF0_t node_remote_profile_data = {
82 0x30, /* 動作状態 */
83 { 0x01, 0x0A, { 0x01, 0x00 } }, /* Version情報 */
84 {
85 0xFE, /* 下位通信層IDフィールド */
86 { MAKER_CODE }, /* メーカーコード */
87 { 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, }, /* ユニークID部(メーカー独自) */
88 },
89 { MAKER_CODE }, /* メーカーコード */
90};
91
92/* ブザークラス */
93struct ecn_cls02A0_t buzzer_data = {
94 0x30, /* 動作状態 */
95 0x41, /* 音発生設定 */
96 0x00, /* 設置場所 */
97 { 0x00, 0x00, 'C', 0x00 }, /* 規格Version情報 */
98 0x42, /* 異常発生状態 */
99 { MAKER_CODE }, /* メーカーコード */
100};
101
102/*
103 * 動作状態ON/OFF設定関数(0x30, 0x31のみ受け付け)
104 */
105int onoff_prop_set(const EPRPINIB *item, const void *src, int size, bool_t *anno)
106{
107 /* サイズが1以外は受け付けない */
108 if(size != 1)
109 return 0;
110
111 *anno = *((uint8_t*)item->exinf) != *((uint8_t*)src);
112
113 switch(*(uint8_t *)src){
114 /* ONの場合 */
115 case 0x30:
116 *((uint8_t *)item->exinf) = *((uint8_t *)src);
117 /* LEDの"."をON */
118 sil_wrb_mem((uint8_t *)0x0008C02A, sil_reb_mem((uint8_t *)0x0008C02A) | 0x40);
119 break;
120 /* OFFの場合 */
121 case 0x31:
122 *((uint8_t *)item->exinf) = *((uint8_t *)src);
123 /* LEDの"."をOFF */
124 sil_wrb_mem((uint8_t *)0x0008C02A, sil_reb_mem((uint8_t *)0x0008C02A) & ~0x40);
125 break;
126 /* 0x30か0x31以外は受け付けない */
127 default:
128 return 0;
129 }
130
131 return 1;
132}
133
134/*
135 * 異常発生状態設定関数(0x41, 0x42のみ受け付け)
136 */
137int alarm_prop_set(const EPRPINIB *item, const void *src, int size, bool_t *anno)
138{
139 /* サイズが1以外は受け付けない */
140 if(size != 1)
141 return 0;
142
143 *anno = *((uint8_t *)item->exinf) != *((uint8_t *)src);
144
145 switch(*(uint8_t *)src){
146 /* 異常発生ありの場合 */
147 case 0x41:
148 /* 異常発生なしの場合 */
149 case 0x42:
150 *((uint8_t *)item->exinf) = *((uint8_t *)src);
151 break;
152 /* 0x41か0x42以外は受け付けない */
153 default:
154 return 0;
155 }
156
157 return 1;
158}
159
160/*
161 * 音発生設定設定関数
162 */
163int ecn_cls02A0_propertyB1_set(const EPRPINIB *item, const void *src, int size, bool_t *anno)
164{
165 uint8_t sseg = sil_reb_mem((uint8_t *)0x0008C02A) & ~0x07;
166
167 /* サイズが1以外は受け付けない */
168 if(size != 1)
169 return 0;
170
171 switch(*(uint8_t *)src){
172 /* 音発生有の場合 */
173 case 0x41:
174 *((uint8_t *)item->exinf) = *((uint8_t *)src);
175 /* LEDを"001"と表示 */
176 sil_wrb_mem((uint8_t *)0x0008C02A, sseg | 0x20);
177 break;
178 /* 音発生無の場合 */
179 case 0x42:
180 *((uint8_t *)item->exinf) = *((uint8_t *)src);
181 /* LEDを"010"と表示 */
182 sil_wrb_mem((uint8_t *)0x0008C02A, sseg | 0x40);
183 break;
184 default:
185 /* 上記以外は受け付けない */
186 return 0;
187 }
188
189 return 1;
190}
191
192/*
193 * 湯切れ警告状態設定関数
194 */
195int no_water_warning_set(const EPRPINIB *item, const void *src, int size, bool_t *anno)
196{
197 ER ret;
198 uint8_t data[2];
199
200 /* サイズが1以外は受け付けない */
201 if(size != 1)
202 return 0;
203
204 *((uint8_t *)item->exinf) = *((uint8_t *)src);
205
206 /* メインタスクに通知 */
207 data[0] = 0x01;
208 data[1] = (*((uint8_t *)src) == 0x41) ? 0x01 : 0x00;
209 ret = ecn_brk_wai(data, sizeof(data));
210 if(ret != E_OK){
211 syslog(LOG_ERROR, "ecn_brk_wai");
212 }
213
214 return 1;
215}
216
217/*
218 * 出湯状態設定関数
219 */
220int discharge_status_set(const EPRPINIB *item, const void *src, int size, bool_t *anno)
221{
222 ER ret;
223 uint8_t data[2];
224
225 /* サイズが1以外は受け付けない */
226 if(size != 1)
227 return 0;
228
229 *((uint8_t *)item->exinf) = *((uint8_t *)src);
230
231 /* メインタスクに通知 */
232 data[0] = 0x02;
233 data[1] = (*((uint8_t *)src) == 0x41) ? 0x01 : 0x00;
234 ret = ecn_brk_wai(data, sizeof(data));
235 if(ret != E_OK){
236 syslog(LOG_ERROR, "ecn_brk_wai");
237 }
238
239 return 1;
240}
241
242static void main_initialize();
243static int main_get_timer();
244static void main_progress(int interval);
245static void main_recv_esv(T_EDATA *esv);
246static void main_break_wait(uint8_t *brkdat, int32_t len);
247static void main_timeout();
248
249/*
250 * メインタスク
251 */
252void echonet_main_task(intptr_t exinf)
253{
254 ER ret, ret2;
255 SYSTIM prev, now;
256 int timer;
257 T_EDATA *esv;
258 uint8_t brkdat[64];
259 int32_t len;
260
261 /* アプリケーションの初期化 */
262 main_initialize();
263
264 ret2 = get_tim(&now);
265 if (ret2 != E_OK){
266 syslog(LOG_ERROR, "get_tim");
267 return;
268 }
269
270 for(;;){
271 prev = now;
272
273 /* タイマー取得 */
274 timer = main_get_timer();
275
276 /* 応答電文待ち */
277 ret = ecn_trcv_esv(&esv, timer);
278 if ((ret != E_OK) && (ret != E_BRK) && (ret != E_TMOUT)){
279 syslog(LOG_ERROR, "ecn_trcv_esv");
280 break;
281 }
282
283 ret2 = get_tim(&now);
284 if (ret2 != E_OK){
285 syslog(LOG_ERROR, "get_tim");
286 break;
287 }
288
289 /* 時間経過 */
290 main_progress(now - prev);
291
292 /* Echonet電文受信の場合 */
293 if (ret == E_OK) {
294 /* Echonet電文受信処理 */
295 main_recv_esv(esv);
296
297 /* 領域解放 */
298 ret = ecn_rel_esv(esv);
299 if (ret != E_OK){
300 syslog(LOG_ERROR, "ecn_rel_esv");
301 break;
302 }
303 }
304 /* 応答電文待ちの割り込みの場合 */
305 else if (ret == E_BRK) {
306 /* 応答電文待ちの割り込みデータ取得 */
307 ret = ecn_get_brk_dat(esv, brkdat, sizeof(brkdat), &len);
308 if (ret != E_OK){
309 syslog(LOG_ERROR, "ecn_get_brk_dat");
310 break;
311 }
312
313 /* 応答電文待ちの割り込み処理 */
314 main_break_wait(brkdat, len);
315
316 /* 領域解放 */
317 ret = ecn_rel_esv(esv);
318 if (ret != E_OK){
319 syslog(LOG_ERROR, "ecn_rel_esv");
320 break;
321 }
322 }
323
324 /* タイムアウト処理 */
325 main_timeout();
326 }
327}
328
329bool_t started = false;
330
331void echonet_change_netif_link(uint8_t link_up, uint8_t up)
332{
333 ER ret;
334
335 if (link_up == 0)
336 return;
337
338 if (up && !started) {
339 started = true;
340
341 /* ECHONETミドルウェアを起動 */
342 ret = ecn_sta_svc();
343 if (ret != E_OK)
344 return;
345
346 /* ECHONETミドルウェアを起動するのを待つ */
347 dly_tsk(100);
348 }
349
350 /* メインタスクに通知 */
351 uint8_t data[2];
352 data[0] = 0x01;
353 data[1] = up ? 0x01 : 0x02;
354 ret = ecn_brk_wai(data, sizeof(data));
355 if (ret != E_OK) {
356 syslog(LOG_ERROR, "ecn_brk_wai");
357 return;
358 }
359}
360
361enum main_state_t{
362 main_state_idle,
363 main_state_search,
364 main_state_buzzer_on,
365};
366
367int main_timer = TMO_FEVR;
368enum main_state_t main_state = main_state_idle;
369
370int main_nop_timer = TMO_FEVR;
371
372/*
373 * 初期化
374 */
375static void main_initialize()
376{
377 /* LEDを"000"と表示 */
378 sil_wrb_mem((uint8_t *)0x0008C02A, 0x00);
379
380 /* 1秒後にブザーを検索 */
381 main_state = main_state_search;
382 main_timer = 1000 * 1000;
383
384 ER ret = act_tsk(MAIN_TASK);
385 if (ret != E_OK) {
386 syslog(LOG_ERROR, "act_tsk");
387 }
388}
389
390/*
391 * タイマー取得
392 */
393static int main_get_timer()
394{
395 int result = main_timer;
396
397 if((result == TMO_FEVR)
398 || ((main_nop_timer != TMO_FEVR) && (main_nop_timer < result))){
399 result = main_nop_timer;
400 }
401
402 return result;
403}
404
405/*
406 * 時間経過
407 */
408static void main_progress(int interval)
409{
410 if(main_timer != TMO_FEVR){
411 main_timer -= interval;
412 if(main_timer < 0){
413 main_timer = 0;
414 }
415 }
416
417 if(main_nop_timer != TMO_FEVR){
418 main_nop_timer -= interval;
419 if(main_nop_timer < 0){
420 main_nop_timer = 0;
421 }
422 }
423}
424
425/*
426 * Echonet電文受信処理
427 */
428static void main_recv_esv(T_EDATA *esv)
429{
430 ER ret;
431 ID eobjid;
432 uint8_t epc;
433 uint8_t pdc;
434 uint8_t p_edt[256];
435 T_ENUM_EPC enm;
436
437 eobjid = ecn_get_eobj(esv);
438 if(eobjid == EOBJ_NULL){
439 syslog(LOG_ERROR, "ecn_get_eobj");
440 return;
441 }
442
443 ret = ecn_itr_ini(&enm, esv);
444 if(ret != E_OK){
445 syslog(LOG_ERROR, "ecn_itr_ini");
446 return;
447 }
448
449 for(;;) {
450 while((ret = ecn_itr_nxt(&enm, &epc, &pdc, p_edt)) == E_OK) {
451 switch (epc) {
452 case 0xD6:
453 switch(main_state){
454 case main_state_search:
455 if (eobjid == POT_NODE_EOBJ) {
456 /* 電気ポット検索完了 */
457 main_state = main_state_idle;
458 main_timer = TMO_FEVR;
459 }
460 break;
461 }
462 break;
463 }
464 }
465 if(ret != E_BOVR){
466 syslog(LOG_ERROR, "ecn_itr_nxt");
467 break;
468 }
469 if(enm.is_eof)
470 break;
471 }
472}
473
474static void main_buzzer_on()
475{
476 ER ret;
477 T_EDATA *esv;
478 uint8_t p_edt[1];
479
480 switch(main_state){
481 case main_state_idle:
482 p_edt[0] = 0x41; /* 音発生有 */
483
484 /* プロパティ設定電文作成 */
485 ret = ecn_esv_seti(&esv, BUZZER_EOBJ, 0xB1, 1, p_edt);
486 if(ret != E_OK){
487 syslog(LOG_ERROR, "ecn_esv_seti");
488 break;
489 }
490
491 /* 電文送信 */
492 ecn_snd_esv(esv);
493 if(ret != E_OK){
494 syslog(LOG_ERROR, "ecn_snd_esv");
495 break;
496 }
497
498 main_state = main_state_buzzer_on;
499 main_timer = 1000 * 1000; /* 1秒鳴動 */
500 break;
501 case main_state_buzzer_on:
502 main_timer = 1000 * 1000; /* 1秒延長 */
503 break;
504 }
505}
506
507static void main_buzzer_off()
508{
509 ER ret;
510 T_EDATA *esv;
511 uint8_t p_edt[1];
512
513 switch(main_state){
514 case main_state_buzzer_on:
515 p_edt[0] = 0x42; /* 音発生無 */
516
517 /* プロパティ設定電文作成 */
518 ret = ecn_esv_seti(&esv, BUZZER_EOBJ, 0xB1, 1, p_edt);
519 if(ret != E_OK){
520 syslog(LOG_ERROR, "ecn_esv_seti");
521 break;
522 }
523
524 /* 電文送信 */
525 ecn_snd_esv(esv);
526 if(ret != E_OK){
527 syslog(LOG_ERROR, "ecn_snd_esv");
528 break;
529 }
530
531 main_state = main_state_idle;
532 main_timer = TMO_FEVR;
533 break;
534 }
535}
536
537/*
538 * 応答電文待ちの割り込み処理
539 */
540static void main_break_wait(uint8_t *brkdat, int32_t len)
541{
542 if (brkdat[0] == 0x01) {
543 // Link up/down
544 return;
545 }
546
547 if(len < 2)
548 return;
549
550 switch(brkdat[0]){
551 case 0x01:
552 if(brkdat[1] != 0)
553 main_buzzer_on();
554 else
555 main_buzzer_off();
556 break;
557 case 0x02:
558 if(brkdat[1] == 0)
559 main_nop_timer = 5000 * 1000; /* 5秒後にブザーON */
560 break;
561 }
562}
563
564static void main_ontimer();
565static void main_nop_timeout();
566
567/*
568 * タイムアウト処理
569 */
570static void main_timeout()
571{
572 if(main_timer == 0){
573 main_ontimer();
574 }
575
576 if(main_nop_timer == 0){
577 main_nop_timeout();
578 }
579}
580
581static void main_search();
582
583static void main_ontimer()
584{
585 switch (main_state)
586 {
587 case main_state_search:
588 /* 電気ポット再検索 */
589 main_search();
590 main_state = main_state_search;
591 main_timer = 5000 * 1000;
592 break;
593 case main_state_buzzer_on:
594 main_buzzer_off();
595 break;
596 default:
597 main_state = main_state_idle;
598 main_timer = TMO_FEVR;
599 break;
600 }
601}
602
603static void main_search()
604{
605 ER ret;
606 T_EDATA *esv;
607
608 /* 電気ポット検索 */
609 ret = ecn_esv_inf_req(&esv, EOBJ_NULL, 0xD6);
610 if(ret != E_OK){
611 syslog(LOG_ERROR, "ecn_esv_inf_req");
612 return;
613 }
614
615 /* 電文送信 */
616 ret = ecn_snd_esv(esv);
617 if(ret != E_OK){
618 syslog(LOG_ERROR, "ecn_snd_esv");
619 }
620}
621
622static void main_nop_timeout()
623{
624 main_buzzer_on();
625
626 main_nop_timer = TMO_FEVR;
627}
Note: See TracBrowser for help on using the repository browser.