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

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

syscallが関数呼びになるよう変更
他更新
  • Property svn:eol-style set to native
  • Property svn:mime-type set to text/x-csrc;charset=UTF-8
File size: 13.9 KB
RevLine 
[337]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"
[342]52#include "target_kernel_impl.h"
[337]53
54/* TODO: メーカーコードを設定 */
[340]55#define MAKER_CODE { 0x00, 0x00, 0xB3 } /* TOPPERSプロジェクト */
[337]56
57/* ノードプロファイルオブジェクト */
58struct ecn_cls0EF0_t node_local_profile_data = {
59 0x30, /* 動作状態 */
60 { 0x01, 0x0A, { 0x01, 0x00 } }, /* Ｖｅｒｓｉｏｎ情報 */
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 }, /* 規格Ｖｅｒｓｉｏｎ情報 */
76 0x42, /* 異常発生状態 */
77 { MAKER_CODE }, /* メーカーコード */
78};
79
80/* ノードプロファイルオブジェクト */
81struct ecn_cls0EF0_t node_remote_profile_data = {
82 0x30, /* 動作状態 */
83 { 0x01, 0x0A, { 0x01, 0x00 } }, /* Ｖｅｒｓｉｏｎ情報 */
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 }, /* 規格Ｖｅｒｓｉｏｎ情報 */
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 /* サイズが１以外は受け付けない */
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 /* サイズが１以外は受け付けない */
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 /* サイズが１以外は受け付けない */
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 /* サイズが１以外は受け付けない */
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
347 /* メインタスクに通知 */
348 uint8_t data[2];
349 data[0] = 0x01;
350 data[1] = up ? 0x01 : 0x02;
351 ret = ecn_brk_wai(data, sizeof(data));
352 if (ret != E_OK) {
353 syslog(LOG_ERROR, "ecn_brk_wai");
354 return;
355 }
356}
357
358enum main_state_t{
359 main_state_idle,
360 main_state_search,
361 main_state_buzzer_on,
362};
363
364int main_timer = TMO_FEVR;
365enum main_state_t main_state = main_state_idle;
366
367int main_nop_timer = TMO_FEVR;
368
369/*
370 * 初期化
371 */
372static void main_initialize()
373{
374 /* LEDを"000"と表示 */
375 sil_wrb_mem((uint8_t *)0x0008C02A, 0x00);
376
377 /* １秒後にブザーを検索 */
378 main_state = main_state_search;
379 main_timer = 1000 * 1000;
[342]380
381 ER ret = act_tsk(MAIN_TASK);
382 if (ret != E_OK) {
383 syslog(LOG_ERROR, "act_tsk");
384 }
[337]385}
386
387/*
388 * タイマー取得
389 */
390static int main_get_timer()
391{
392 int result = main_timer;
393
394 if((result == TMO_FEVR)
395 || ((main_nop_timer != TMO_FEVR) && (main_nop_timer < result))){
396 result = main_nop_timer;
397 }
398
399 return result;
400}
401
402/*
403 * 時間経過
404 */
405static void main_progress(int interval)
406{
407 if(main_timer != TMO_FEVR){
408 main_timer -= interval;
409 if(main_timer < 0){
410 main_timer = 0;
411 }
412 }
413
414 if(main_nop_timer != TMO_FEVR){
415 main_nop_timer -= interval;
416 if(main_nop_timer < 0){
417 main_nop_timer = 0;
418 }
419 }
420}
421
422/*
423 * Echonet電文受信処理
424 */
425static void main_recv_esv(T_EDATA *esv)
426{
427 ER ret;
428 ID eobjid;
429 uint8_t epc;
430 uint8_t pdc;
431 uint8_t p_edt[256];
432 T_ENUM_EPC enm;
433
434 eobjid = ecn_get_eobj(esv);
435 if(eobjid == EOBJ_NULL){
436 syslog(LOG_ERROR, "ecn_get_eobj");
437 return;
438 }
439
440 ret = ecn_itr_ini(&enm, esv);
441 if(ret != E_OK){
442 syslog(LOG_ERROR, "ecn_itr_ini");
443 return;
444 }
445
446 for(;;) {
447 while((ret = ecn_itr_nxt(&enm, &epc, &pdc, p_edt)) == E_OK) {
448 switch (epc) {
449 case 0xD6:
450 switch(main_state){
451 case main_state_search:
452 if (eobjid == POT_NODE_EOBJ) {
453 /* 電気ポット検索完了 */
454 main_state = main_state_idle;
455 main_timer = TMO_FEVR;
456 }
457 break;
458 }
459 break;
460 }
461 }
462 if(ret != E_BOVR){
463 syslog(LOG_ERROR, "ecn_itr_nxt");
464 break;
465 }
466 if(enm.is_eof)
467 break;
468 }
469}
470
471static void main_buzzer_on()
472{
473 ER ret;
474 T_EDATA *esv;
475 uint8_t p_edt[1];
476
477 switch(main_state){
478 case main_state_idle:
479 p_edt[0] = 0x41; /* 音発生有 */
480
481 /* プロパティ設定電文作成 */
482 ret = ecn_esv_seti(&esv, BUZZER_EOBJ, 0xB1, 1, p_edt);
483 if(ret != E_OK){
484 syslog(LOG_ERROR, "ecn_esv_seti");
485 break;
486 }
487
488 /* 電文送信 */
489 ecn_snd_esv(esv);
490 if(ret != E_OK){
491 syslog(LOG_ERROR, "ecn_snd_esv");
492 break;
493 }
494
495 main_state = main_state_buzzer_on;
496 main_timer = 1000 * 1000; /* １秒鳴動 */
497 break;
498 case main_state_buzzer_on:
499 main_timer = 1000 * 1000; /* １秒延長 */
500 break;
501 }
502}
503
504static void main_buzzer_off()
505{
506 ER ret;
507 T_EDATA *esv;
508 uint8_t p_edt[1];
509
510 switch(main_state){
511 case main_state_buzzer_on:
512 p_edt[0] = 0x42; /* 音発生無 */
513
514 /* プロパティ設定電文作成 */
515 ret = ecn_esv_seti(&esv, BUZZER_EOBJ, 0xB1, 1, p_edt);
516 if(ret != E_OK){
517 syslog(LOG_ERROR, "ecn_esv_seti");
518 break;
519 }
520
521 /* 電文送信 */
522 ecn_snd_esv(esv);
523 if(ret != E_OK){
524 syslog(LOG_ERROR, "ecn_snd_esv");
525 break;
526 }
527
528 main_state = main_state_idle;
529 main_timer = TMO_FEVR;
530 break;
531 }
532}
533
534/*
535 * 応答電文待ちの割り込み処理
536 */
537static void main_break_wait(uint8_t *brkdat, int32_t len)
538{
539 if (brkdat[0] == 0x01) {
540 // Link up/down
541 return;
542 }
543
544 if(len < 2)
545 return;
546
547 switch(brkdat[0]){
548 case 0x01:
549 if(brkdat[1] != 0)
550 main_buzzer_on();
551 else
552 main_buzzer_off();
553 break;
554 case 0x02:
555 if(brkdat[1] == 0)
556 main_nop_timer = 5000 * 1000; /* ５秒後にブザーON */
557 break;
558 }
559}
560
561static void main_ontimer();
562static void main_nop_timeout();
563
564/*
565 * タイムアウト処理
566 */
567static void main_timeout()
568{
569 if(main_timer == 0){
570 main_ontimer();
571 }
572
573 if(main_nop_timer == 0){
574 main_nop_timeout();
575 }
576}
577
578static void main_search();
579
580static void main_ontimer()
581{
582 switch (main_state)
583 {
584 case main_state_search:
585 /* 電気ポット再検索 */
586 main_search();
587 main_state = main_state_search;
588 main_timer = 5000 * 1000;
589 break;
590 case main_state_buzzer_on:
591 main_buzzer_off();
592 break;
593 default:
594 main_state = main_state_idle;
595 main_timer = TMO_FEVR;
596 break;
597 }
598}
599
600static void main_search()
601{
602 ER ret;
603 T_EDATA *esv;
604
605 /* 電気ポット検索 */
606 ret = ecn_esv_inf_req(&esv, EOBJ_NULL, 0xD6);
607 if(ret != E_OK){
608 syslog(LOG_ERROR, "ecn_esv_inf_req");
609 return;
610 }
611
612 /* 電文送信 */
613 ret = ecn_snd_esv(esv);
614 if(ret != E_OK){
615 syslog(LOG_ERROR, "ecn_snd_esv");
616 }
617}
618
619static void main_nop_timeout()
620{
621 main_buzzer_on();
622
623 main_nop_timer = TMO_FEVR;
624}
Note: See TracBrowser for help on using the repository browser.