1 | /*
|
---|
2 | * TOPPERS ECHONET Lite Communication Middleware
|
---|
3 | *
|
---|
4 | * Copyright (C) 2014 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: echonet.c 265 2016-11-18 08:30:16Z coas-nagasima $
|
---|
36 | */
|
---|
37 |
|
---|
38 | #include <kernel.h>
|
---|
39 | #include <stdio.h>
|
---|
40 | #include <string.h>
|
---|
41 |
|
---|
42 | #include "echonet.h"
|
---|
43 | #include "echonet_fbs.h"
|
---|
44 | #include "echonet_task.h"
|
---|
45 | #include "echonet_dbg.h"
|
---|
46 | #include "echonet_agent.h"
|
---|
47 |
|
---|
48 | /*
|
---|
49 | * ECHONET Liteサービス処理開始
|
---|
50 | */
|
---|
51 | ER ecn_sta_svc()
|
---|
52 | {
|
---|
53 | return act_tsk(ecn_udp_taskid);
|
---|
54 | }
|
---|
55 |
|
---|
56 | /*
|
---|
57 | * ECHONETオブジェクト参照
|
---|
58 | * 引数
|
---|
59 | * ID fa_eobjid ECHONETオブジェクトID
|
---|
60 | * T_REOBJ *fp_eobj ECHONETオブジェクトの設定内容コピー先
|
---|
61 | *
|
---|
62 | * eobjidで指定したECHONETオブジェクトの設定内容を参照する。
|
---|
63 | * 参照した設定内容はpk_eobjに指定したメモリに返される。
|
---|
64 | */
|
---|
65 | ER ecn_ref_eobj(ID fa_eobjid, T_REOBJ *fp_eobj)
|
---|
66 | {
|
---|
67 | const EOBJINIB *p_obj;
|
---|
68 |
|
---|
69 | if (!fp_eobj)
|
---|
70 | return E_PAR; /* パラメータエラー */
|
---|
71 |
|
---|
72 | if ((fa_eobjid <= 0) || (fa_eobjid > tmax_eobjid))
|
---|
73 | return E_OBJ; /* オブジェクト未登録 */
|
---|
74 |
|
---|
75 | p_obj = &eobjinib_table[fa_eobjid - 1];
|
---|
76 |
|
---|
77 | *fp_eobj = *p_obj;
|
---|
78 |
|
---|
79 | return E_OK;
|
---|
80 | }
|
---|
81 |
|
---|
82 | /*
|
---|
83 | * ECHONETプロパティ参照
|
---|
84 | * 引数
|
---|
85 | * ID fa_eobjid ECHONETオブジェクトID
|
---|
86 | * uint8_t fa_epc プロパティコード
|
---|
87 | * T_RPRP *fp_eprp ECHONETオブジェクトのプロパティ設定内容コピー先
|
---|
88 | *
|
---|
89 | * eobjidで指定したECHONETオブジェクトの、epcで指定したプロパティの設定内容を参照する。
|
---|
90 | * 参照した設定内容はpk_eprpに指定したメモリに返される。
|
---|
91 | */
|
---|
92 | ER ecn_ref_eprp(ID fa_eobjid, uint8_t fa_epc, T_RPRP *fp_eprp)
|
---|
93 | {
|
---|
94 | const EOBJINIB *p_obj;
|
---|
95 | const EPRPINIB *p;
|
---|
96 | uint_t i;
|
---|
97 |
|
---|
98 | if (!fp_eprp)
|
---|
99 | return E_PAR; /* パラメータエラー */
|
---|
100 |
|
---|
101 | if ((fa_eobjid <= 0) || (fa_eobjid > tmax_eobjid))
|
---|
102 | return E_OBJ; /* オブジェクト未登録 */
|
---|
103 |
|
---|
104 | p_obj = &eobjinib_table[fa_eobjid - 1];
|
---|
105 |
|
---|
106 | /* eojの持つプロパティ初期化定義配列から検索 */
|
---|
107 | p = p_obj->eprp;
|
---|
108 | for (i = 0; i < p_obj->eprpcnt; i++, p++) {
|
---|
109 | if (p->eprpcd != fa_epc)
|
---|
110 | continue;
|
---|
111 | *fp_eprp = *p;
|
---|
112 | return E_OK;
|
---|
113 | }
|
---|
114 |
|
---|
115 | return E_PAR; /* パラメータエラー */
|
---|
116 | }
|
---|
117 |
|
---|
118 | /*
|
---|
119 | * プロパティ値書き込み要求(応答不要)電文作成
|
---|
120 | * 引数
|
---|
121 | * T_EDATA **ppk_esv 取得した電文の格納先
|
---|
122 | * ID fa_deoj 宛先のECHONETオブジェクトID
|
---|
123 | * uint8_t fa_epc プロパティコード
|
---|
124 | * uint8_t fa_pdc プロパティ値データサイズ
|
---|
125 | * const void *p_edt プロパティ値データ
|
---|
126 | *
|
---|
127 | * プロパティ値書き込み要求(応答不要)電文を作成する。
|
---|
128 | * 電文はdeojで指定したECHONETオブジェクトを宛先とし、
|
---|
129 | * 電文の初めのプロパティ値として、epcとpdc、p_edtで指定された
|
---|
130 | * プロパティコード、データサイズ、データを電文に設定する。
|
---|
131 | * 作成した電文の先頭アドレスはポインタ経由で返される。
|
---|
132 | */
|
---|
133 | ER ecn_esv_seti(T_EDATA **ppk_esv, ID fa_deoj, uint8_t fa_epc, uint8_t fa_pdc,
|
---|
134 | const void *p_edt)
|
---|
135 | {
|
---|
136 | return _ecn_tsk_mk_esv((ECN_FBS_ID *)ppk_esv, (ID)1, fa_deoj, fa_epc, fa_pdc, p_edt, ESV_SET_I);
|
---|
137 | }
|
---|
138 |
|
---|
139 | /*
|
---|
140 | * プロパティ値書き込み要求(応答要)電文作成
|
---|
141 | * 引数
|
---|
142 | * T_EDATA **ppk_esv 取得した電文の格納先
|
---|
143 | * ID fa_deoj 宛先のECHONETオブジェクトID
|
---|
144 | * uint8_t fa_epc プロパティコード
|
---|
145 | * uint8_t fa_pdc プロパティ値データサイズ
|
---|
146 | * const void *p_edt プロパティ値データ
|
---|
147 | *
|
---|
148 | * プロパティ値書き込み要求(応答要)電文を作成する。
|
---|
149 | * 電文はdeojで指定したECHONETオブジェクトを宛先とし、
|
---|
150 | * 電文の初めのプロパティ値として、epcとpdc、p_edtで指定された
|
---|
151 | * プロパティコード、データサイズ、データを電文に設定する。
|
---|
152 | * 作成した電文の先頭アドレスはポインタ経由で返される。
|
---|
153 | */
|
---|
154 | ER ecn_esv_setc(T_EDATA **ppk_esv, ID fa_deoj, uint8_t fa_epc, uint8_t fa_pdc,
|
---|
155 | const void *p_edt)
|
---|
156 | {
|
---|
157 | return _ecn_tsk_mk_esv((ECN_FBS_ID *)ppk_esv, (ID)1, fa_deoj, fa_epc, fa_pdc, p_edt, ESV_SET_C);
|
---|
158 | }
|
---|
159 |
|
---|
160 | /*
|
---|
161 | * プロパティ値読み出し要求電文作成
|
---|
162 | * 引数
|
---|
163 | * T_EDATA **ppk_esv 取得した電文の格納先
|
---|
164 | * ID fa_deoj 宛先のECHONETオブジェクトID
|
---|
165 | * uint8_t fa_epc プロパティコード
|
---|
166 | *
|
---|
167 | * プロパティ値読み出し要求電文を作成する。
|
---|
168 | * 電文はdeojで指定したECHONETオブジェクトを宛先とし、
|
---|
169 | * 電文の初めのプロパティ値として、epcで指定された
|
---|
170 | * プロパティコードを電文に設定する。
|
---|
171 | * 作成した電文の先頭アドレスはポインタ経由で返される。
|
---|
172 | */
|
---|
173 | ER ecn_esv_get(T_EDATA **ppk_esv, ID fa_deoj, uint8_t fa_epc)
|
---|
174 | {
|
---|
175 | return _ecn_tsk_mk_esv((ECN_FBS_ID *)ppk_esv, (ID)1, fa_deoj, fa_epc, 0, NULL, ESV_GET);
|
---|
176 | }
|
---|
177 |
|
---|
178 | /*
|
---|
179 | * プロパティ値通知要求電文作成
|
---|
180 | * 引数
|
---|
181 | * T_EDATA **ppk_esv 取得した電文の格納先
|
---|
182 | * ID fa_deoj 宛先のECHONETオブジェクトID
|
---|
183 | * uint8_t fa_epc プロパティコード
|
---|
184 | *
|
---|
185 | * プロパティ値通知要求電文を作成する。
|
---|
186 | * 電文はdeojで指定したECHONETオブジェクトを宛先とし、
|
---|
187 | * 電文の初めのプロパティ値として、epcで指定された
|
---|
188 | * プロパティコードを電文に設定する。
|
---|
189 | * 作成した電文の先頭アドレスはポインタ経由で返される。
|
---|
190 | */
|
---|
191 | ER ecn_esv_inf_req(T_EDATA **ppk_esv, ID fa_deoj, uint8_t fa_epc)
|
---|
192 | {
|
---|
193 | return _ecn_tsk_mk_esv((ECN_FBS_ID *)ppk_esv, (ID)1, fa_deoj, fa_epc, 0, NULL, ESV_INF_REQ);
|
---|
194 | }
|
---|
195 |
|
---|
196 | /*
|
---|
197 | * プロパティ値書き込み・読み出し要求電文作成
|
---|
198 | * 引数
|
---|
199 | * T_EDATA **ppk_esv 取得した電文の格納先
|
---|
200 | * ID fa_deoj 宛先のECHONETオブジェクトID
|
---|
201 | * uint8_t fa_epc プロパティコード
|
---|
202 | * uint8_t fa_pdc プロパティ値データサイズ
|
---|
203 | * const void *p_edt プロパティ値データ
|
---|
204 | *
|
---|
205 | * プロパティ値書き込み・読み出し要求電文を作成する。
|
---|
206 | * 電文はdeojで指定したECHONETオブジェクトを宛先とし、
|
---|
207 | * 電文の初めのプロパティ値として、epcとpdc、p_edtで指定された
|
---|
208 | * プロパティコード、データサイズ、データを電文に設定する。
|
---|
209 | * 作成した電文の先頭アドレスはポインタ経由で返される。
|
---|
210 | */
|
---|
211 | ER ecn_esv_set_get(T_EDATA **ppk_esv, ID fa_deoj, uint8_t fa_epc, uint8_t fa_pdc,
|
---|
212 | const void *p_edt)
|
---|
213 | {
|
---|
214 | return _ecn_tsk_mk_esv((ECN_FBS_ID *)ppk_esv, (ID)1, fa_deoj, fa_epc, fa_pdc, p_edt, ESV_SET_GET);
|
---|
215 | }
|
---|
216 |
|
---|
217 | /*
|
---|
218 | * プロパティ値書き込み・読み出し要求電文作成:折り返し指定
|
---|
219 | * プロパティ値書き込み・読み出し要求電文作成中の、書き込みプロパティ配列を終えて
|
---|
220 | * 読み出しプロパティ配列に移る時に用いる。
|
---|
221 | */
|
---|
222 | ER ecn_trn_set_get(T_EDATA *ppk_esv, int *p_trn_pos)
|
---|
223 | {
|
---|
224 | ER a_ret;
|
---|
225 |
|
---|
226 | if (!ppk_esv)
|
---|
227 | return E_PAR;
|
---|
228 | if (!p_trn_pos)
|
---|
229 | return E_PAR;
|
---|
230 |
|
---|
231 | /* プロパティ読み込み件数書き込み時のヘッド情報を記録 */
|
---|
232 | *p_trn_pos = _ecn_fbs_get_datalen(*(ECN_FBS_ID *)&ppk_esv);
|
---|
233 |
|
---|
234 | /* 応答電文用メモリにデータ追加・この時点での応答電文中プロパティ件数を記録 */
|
---|
235 | a_ret = _ecn_fbs_add_data_ex(*(ECN_FBS_ID *)&ppk_esv, &ppk_esv->hdr.edata.opc, 1);
|
---|
236 | if (a_ret) {
|
---|
237 | ECN_DBG_PUT("ecn_trn_set_get(): _ecn_fbs_add_data_ex() result = %d:%s", a_ret, itron_strerror(a_ret));
|
---|
238 | return a_ret;
|
---|
239 | }
|
---|
240 |
|
---|
241 | /* 応答電文中プロパティ件数を 0 に戻す(今後、終了指定するまでは読み出しプロパティ件数になる) */
|
---|
242 | ppk_esv->hdr.edata.opc = 0;
|
---|
243 |
|
---|
244 | return E_OK;
|
---|
245 | }
|
---|
246 |
|
---|
247 | /*
|
---|
248 | * プロパティ値書き込み・読み出し要求電文作成:終了指定
|
---|
249 | * プロパティ値書き込み・読み出し要求電文作成中の、読み出しプロパティ配列を終える時に用いる。
|
---|
250 | */
|
---|
251 | ER ecn_end_set_get(T_EDATA *ppk_esv, int fa_trn_pos)
|
---|
252 | {
|
---|
253 | ER a_ret;
|
---|
254 | int a_wr_opc;
|
---|
255 | uint8_t a_rd_opc;
|
---|
256 |
|
---|
257 | if (!ppk_esv)
|
---|
258 | return E_PAR;
|
---|
259 |
|
---|
260 | /* この時点での応答電文中プロパティ件数(読み出しプロパティ件数)を保持 */
|
---|
261 | a_rd_opc = ppk_esv->hdr.edata.opc;
|
---|
262 |
|
---|
263 | /* 応答電文中プロパティ件数(書き込みプロパティ件数)を保存位置から読み取り */
|
---|
264 | a_wr_opc = _ecn_fbs_peek(*(ECN_FBS_ID *)&ppk_esv, fa_trn_pos);
|
---|
265 | if (a_wr_opc < 0) {
|
---|
266 | ECN_DBG_PUT("ecn_end_set_get(): _ecn_fbs_peek() result = %d:%s", a_wr_opc, itron_strerror(a_wr_opc));
|
---|
267 | return a_wr_opc;
|
---|
268 | }
|
---|
269 |
|
---|
270 | /* 応答電文中プロパティ件数(書き込みプロパティ件数)を復元 */
|
---|
271 | ppk_esv->hdr.edata.opc = (uint8_t)a_wr_opc;
|
---|
272 |
|
---|
273 | /* 応答電文中プロパティ件数(読み出しプロパティ件数)を保存位置に書き込み */
|
---|
274 | a_ret = _ecn_fbs_poke(*(ECN_FBS_ID *)&ppk_esv, fa_trn_pos, a_rd_opc);
|
---|
275 | if (a_ret) {
|
---|
276 | ECN_DBG_PUT("ecn_end_set_get(): _ecn_fbs_poke() result = %d:%s", a_ret, itron_strerror(a_ret));
|
---|
277 | return a_ret;
|
---|
278 | }
|
---|
279 |
|
---|
280 | return E_OK;
|
---|
281 | }
|
---|
282 |
|
---|
283 | /*
|
---|
284 | * プロパティ値通知(応答要)電文作成
|
---|
285 | * 引数
|
---|
286 | * T_EDATA **ppk_esv 取得した電文の格納先
|
---|
287 | * ID fa_deoj 宛先のECHONETオブジェクトID
|
---|
288 | * ID fa_seoj 送信元のECHONETオブジェクトID
|
---|
289 | * uint8_t fa_sepc 送信元のプロパティコード
|
---|
290 | */
|
---|
291 | ER ecn_esv_infc(T_EDATA **ppk_esv, ID fa_deoj, ID fa_seoj, uint8_t fa_sepc)
|
---|
292 | {
|
---|
293 | return _ecn_tsk_mk_esv((ECN_FBS_ID *)ppk_esv, fa_seoj, fa_deoj, fa_sepc, 0, NULL, ESV_INFC);
|
---|
294 | }
|
---|
295 |
|
---|
296 | /*
|
---|
297 | * 要求電文へのプロパティ指定追加 (プロパティデータが付随しない場合に用いる)
|
---|
298 | */
|
---|
299 | ER ecn_add_epc(T_EDATA *pk_esv, uint8_t epc)
|
---|
300 | {
|
---|
301 | return ecn_add_edt(pk_esv, epc, 0, 0);
|
---|
302 | }
|
---|
303 |
|
---|
304 | /*
|
---|
305 | * 要求電文へのプロパティデータ追加 (プロパティおよび付随データを追加する)
|
---|
306 | */
|
---|
307 | ER ecn_add_edt(T_EDATA *pk_esv, uint8_t fa_epc, uint8_t fa_pdc, const void *p_edt)
|
---|
308 | {
|
---|
309 | ECN_FBS_ID a_fbs_id;
|
---|
310 | ER a_ret;
|
---|
311 | T_ECN_PRP a_ecn_prp;
|
---|
312 |
|
---|
313 | if (!pk_esv)
|
---|
314 | return E_PAR; /* 取得したFBS_IDの格納先がNULL */
|
---|
315 | if (ECHONET_MEMPOOL_BLOCK_SIZE <= fa_pdc)
|
---|
316 | return E_PAR; /* プロパティ値サイズが大きすぎる */
|
---|
317 | if (!p_edt && 0 < fa_pdc)
|
---|
318 | return E_PAR; /* プロパティ値サイズが1以上なのにデータポインタがNULL */
|
---|
319 |
|
---|
320 | a_fbs_id.ptr = (T_ECN_FST_BLK *)pk_esv;
|
---|
321 | if (((T_EDATA *)a_fbs_id.ptr)->hdr.edata.opc == 0xFF)
|
---|
322 | return E_PAR; /* プロパティが多すぎる */
|
---|
323 |
|
---|
324 | /* 要求電文用メモリにデータ追加 */
|
---|
325 | memset(&a_ecn_prp, 0, sizeof(a_ecn_prp));
|
---|
326 | a_ecn_prp.epc = fa_epc;
|
---|
327 | a_ecn_prp.pdc = fa_pdc;
|
---|
328 | a_ret = _ecn_fbs_add_data_ex(a_fbs_id, &a_ecn_prp, sizeof(a_ecn_prp));
|
---|
329 | if (a_ret) {
|
---|
330 | ECN_DBG_PUT("ecn_add_edt(): _ecn_fbs_add_data_ex(*, ecn_prp{epc:0x%02X}, %u) result = %d:%s",
|
---|
331 | a_ecn_prp.epc, sizeof(a_ecn_prp), a_ret, itron_strerror(a_ret));
|
---|
332 | goto lb_except;
|
---|
333 | }
|
---|
334 | if (0 < fa_pdc) {
|
---|
335 | /* 付随データ追加 */
|
---|
336 | a_ret = _ecn_fbs_add_data_ex(a_fbs_id, p_edt, fa_pdc);
|
---|
337 | if (a_ret) {
|
---|
338 | ECN_DBG_PUT("ecn_add_edt(): _ecn_fbs_add_data_ex(*, ecn_prp{epc:0x%02X} edt, %u) result = %d:%s",
|
---|
339 | a_ecn_prp.epc, fa_pdc, a_ret, itron_strerror(a_ret));
|
---|
340 | goto lb_except;
|
---|
341 | }
|
---|
342 | }
|
---|
343 | /* プロパティ数インクリメント */
|
---|
344 | ((T_EDATA *)a_fbs_id.ptr)->hdr.edata.opc++;
|
---|
345 |
|
---|
346 | lb_except:
|
---|
347 | return a_ret;
|
---|
348 | }
|
---|
349 |
|
---|
350 | /*
|
---|
351 | * 要求電文の送信
|
---|
352 | * esvで指定された要求電文を送信する。
|
---|
353 | * 電文に指定された宛先からIPアドレスを特定し、UDPパケットとして送信する。
|
---|
354 | */
|
---|
355 | ER ecn_snd_esv(T_EDATA *pk_esv)
|
---|
356 | {
|
---|
357 | ECN_FBS_ID a_rsp_fbs;
|
---|
358 | a_rsp_fbs.ptr = (T_ECN_FST_BLK *)pk_esv;
|
---|
359 | return _ecn_tsk_snd_mbx(a_rsp_fbs, true);
|
---|
360 | }
|
---|
361 |
|
---|
362 | /*
|
---|
363 | * 応答電文の受信ポーリング
|
---|
364 | * 応答電文を受信するのを待つ。
|
---|
365 | * 受信した応答電文はppk_esvで指定したポインターに先頭アドレスが返される。
|
---|
366 | * 応答電文の受信の有無にかかわらず、待たずに関数を抜ける。
|
---|
367 | */
|
---|
368 | ER ecn_prcv_esv(T_EDATA **ppk_esv)
|
---|
369 | {
|
---|
370 | intptr_t p_msg = 0;
|
---|
371 | ER a_ret;
|
---|
372 |
|
---|
373 | if (!ppk_esv)
|
---|
374 | return E_PAR;
|
---|
375 |
|
---|
376 | a_ret = prcv_dtq(ecn_api_mailboxid, &p_msg);
|
---|
377 | if (a_ret != E_OK) {
|
---|
378 | *ppk_esv = NULL;
|
---|
379 | return a_ret;
|
---|
380 | }
|
---|
381 |
|
---|
382 | *ppk_esv = (T_EDATA *)p_msg;
|
---|
383 | return (((T_ECN_FST_BLK *)p_msg)->hdr.type == ECN_MSG_ECHONET) ? E_OK : E_BRK;
|
---|
384 | }
|
---|
385 |
|
---|
386 | /*
|
---|
387 | * 応答電文の破棄
|
---|
388 | */
|
---|
389 | ER ecn_rel_esv(T_EDATA *pk_esv)
|
---|
390 | {
|
---|
391 | ECN_FBS_ID a_fbs;
|
---|
392 | ER a_ret;
|
---|
393 |
|
---|
394 | a_fbs.ptr = (T_ECN_FST_BLK *)pk_esv;
|
---|
395 | a_ret = _ecn_fbs_del(a_fbs);
|
---|
396 | return a_ret;
|
---|
397 | }
|
---|
398 |
|
---|
399 | /*
|
---|
400 | * 応答電文の送信元ノードを取得する
|
---|
401 | */
|
---|
402 | ID ecn_get_enod(T_EDATA *pk_esv)
|
---|
403 | {
|
---|
404 | const EOBJCB *p_snod;
|
---|
405 | const EOBJINIB *p_sobj = NULL;
|
---|
406 | T_ECN_EDT_HDR *p_esv;
|
---|
407 |
|
---|
408 | p_esv = &pk_esv->hdr;
|
---|
409 | p_snod = _ecn_eno_fnd(((T_ECN_FST_BLK *)pk_esv)->hdr.sender.id);
|
---|
410 | if (p_snod != NULL) {
|
---|
411 | p_sobj = p_snod->profile;
|
---|
412 | }
|
---|
413 |
|
---|
414 | if (p_sobj == NULL)
|
---|
415 | return EOBJ_NULL;
|
---|
416 | #ifdef ECHONET_CONTROLLER_EXTENTION
|
---|
417 | if (p_sobj->eprpcnt == 0)
|
---|
418 | return ecn_agent_get_eobj(p_sobj);
|
---|
419 | #endif
|
---|
420 | return 1 + (((intptr_t)p_sobj - (intptr_t)eobjinib_table) / sizeof(EOBJINIB));
|
---|
421 | }
|
---|
422 |
|
---|
423 | /*
|
---|
424 | * 応答電文の送信元機器オブジェクトを取得する
|
---|
425 | */
|
---|
426 | ID ecn_get_eobj(T_EDATA *pk_esv)
|
---|
427 | {
|
---|
428 | const EOBJCB *p_snod;
|
---|
429 | const EOBJINIB *p_sobj = NULL;
|
---|
430 | T_ECN_EDT_HDR *p_esv;
|
---|
431 |
|
---|
432 | p_esv = &pk_esv->hdr;
|
---|
433 | p_snod = _ecn_eno_fnd(((T_ECN_FST_BLK *)pk_esv)->hdr.sender.id);
|
---|
434 | if (p_snod != NULL) {
|
---|
435 | /* ノードプロファイルの場合 */
|
---|
436 | if ((p_esv->edata.seoj.eojx1 == EOJ_X1_PROFILE)
|
---|
437 | && (p_esv->edata.seoj.eojx2 == EOJ_X2_NODE_PROFILE)) {
|
---|
438 | p_sobj = p_snod->profile;
|
---|
439 | }
|
---|
440 | /* 機器オブジェクトの場合 */
|
---|
441 | else {
|
---|
442 | p_sobj = _ecn_eoj_fnd(p_snod, &p_esv->edata.seoj);
|
---|
443 | }
|
---|
444 | }
|
---|
445 |
|
---|
446 | if (p_sobj == NULL)
|
---|
447 | return EOBJ_NULL;
|
---|
448 | #ifdef ECHONET_CONTROLLER_EXTENTION
|
---|
449 | if (p_sobj->eprpcnt == 0)
|
---|
450 | return ecn_agent_get_eobj(p_sobj);
|
---|
451 | #endif
|
---|
452 | return 1 + (((intptr_t)p_sobj - (intptr_t)eobjinib_table) / sizeof(EOBJINIB));
|
---|
453 | }
|
---|
454 |
|
---|
455 | /*
|
---|
456 | * 応答電文解析イテレーター初期化
|
---|
457 | */
|
---|
458 | ER ecn_itr_ini(T_ENUM_EPC *pk_itr, T_EDATA *pk_esv)
|
---|
459 | {
|
---|
460 | if (!pk_itr)
|
---|
461 | return E_PAR;
|
---|
462 | if (!pk_esv)
|
---|
463 | return E_PAR;
|
---|
464 |
|
---|
465 | memset(pk_itr, 0, sizeof(*pk_itr));
|
---|
466 | pk_itr->pk_esv = pk_esv;
|
---|
467 | pk_itr->count = pk_esv->hdr.edata.opc;
|
---|
468 | /* 今のブロックでのプロパティ総数 */
|
---|
469 | pk_itr->got_ct = 0; /* 今のブロックで、読み取った数 */
|
---|
470 | pk_itr->next_blk_ct = 0; /* 後続ブロック数 */
|
---|
471 | pk_itr->is_eof = 0; /* 終端に達した時、非0 */
|
---|
472 | pk_itr->cur = offsetof(T_ECN_EDT_HDR, ecn_prp);
|
---|
473 |
|
---|
474 | switch (pk_esv->hdr.edata.esv) {
|
---|
475 | case ESV_SET_GET: /* 0x6E プロパティ値書き込み・読み出し要求 */
|
---|
476 | case ESV_SET_GET_RES: /* 0x7E プロパティ値書き込み・読み出し応答 */
|
---|
477 | case ESV_SET_GET_SNA: /* 0x5E プロパティ値書き込み・読み出し不可応答 */
|
---|
478 | pk_itr->next_blk_ct ++;
|
---|
479 | default:
|
---|
480 | break;
|
---|
481 | }
|
---|
482 |
|
---|
483 | return E_OK;
|
---|
484 | }
|
---|
485 |
|
---|
486 | /*
|
---|
487 | * 応答電文解析イテレーターインクリメント
|
---|
488 | */
|
---|
489 | ER ecn_itr_nxt(T_ENUM_EPC *pk_itr, uint8_t *p_epc, uint8_t *p_pdc, void *p_edt)
|
---|
490 | {
|
---|
491 | ECN_FBS_ID a_fbs_id;
|
---|
492 | int a_rd_bak;
|
---|
493 | ER a_ret;
|
---|
494 | ECN_FBS_SSIZE_T a_rd_len;
|
---|
495 | T_ECN_PRP a_ecn_prp;
|
---|
496 |
|
---|
497 | if (!pk_itr)
|
---|
498 | return E_PAR;
|
---|
499 | if (!p_epc)
|
---|
500 | return E_PAR;
|
---|
501 | if (!p_pdc)
|
---|
502 | return E_PAR;
|
---|
503 | if (!pk_itr->pk_esv)
|
---|
504 | return E_PAR;
|
---|
505 |
|
---|
506 | if (pk_itr->is_eof)
|
---|
507 | return E_BOVR; /* データ終了 */
|
---|
508 | if (pk_itr->count <= pk_itr->got_ct && pk_itr->next_blk_ct < 1) {
|
---|
509 | pk_itr->is_eof = 1; /* 終端に達した時、非0 */
|
---|
510 | return E_BOVR; /* データ終了 */
|
---|
511 | }
|
---|
512 |
|
---|
513 | a_fbs_id.ptr = (T_ECN_FST_BLK *)pk_itr->pk_esv;
|
---|
514 |
|
---|
515 | /* 元のカーソル位置を保存し、イテレータのカーソル位置にする */
|
---|
516 | a_rd_bak = a_fbs_id.ptr->hdr.rd;
|
---|
517 | a_fbs_id.ptr->hdr.rd = pk_itr->cur;
|
---|
518 |
|
---|
519 | #ifdef ECN_ENA_ITR_NXT_CARP
|
---|
520 | ECN_CAP_PUT("ecn_itr_nxt() rd.cur=b%dp%d", pk_itr->cur.blk, pk_itr->cur.pos);
|
---|
521 | #endif
|
---|
522 | if (pk_itr->count <= pk_itr->got_ct && 0 < pk_itr->next_blk_ct) {
|
---|
523 | /* 次ブロックに移動 */
|
---|
524 | pk_itr->next_blk_ct --;
|
---|
525 | pk_itr->count = 0; /* 今のブロックでのプロパティ総数 */
|
---|
526 | pk_itr->got_ct = 0; /* 今のブロックで、読み取った数 */
|
---|
527 |
|
---|
528 | /* 次ブロックのプロパティ数を読み取る */
|
---|
529 | a_rd_len = 0;
|
---|
530 | a_ret = _ecn_fbs_get_data(a_fbs_id, &a_ecn_prp.pdc, 1, &a_rd_len);
|
---|
531 | if (a_ret != E_OK)
|
---|
532 | goto lb_except;
|
---|
533 | if (0 < a_rd_len) {
|
---|
534 | pk_itr->count = a_ecn_prp.pdc; /* 今のブロックでのプロパティ総数 */
|
---|
535 | }
|
---|
536 | a_ret = E_BOVR; /* データ終了 */
|
---|
537 | goto lb_finally;
|
---|
538 | }
|
---|
539 |
|
---|
540 | /* プロパティコードとデータサイズを読み取る */
|
---|
541 | memset(&a_ecn_prp, 0, sizeof(a_ecn_prp));
|
---|
542 | a_rd_len = 0;
|
---|
543 | a_ret = _ecn_fbs_get_data(a_fbs_id, &a_ecn_prp, sizeof(a_ecn_prp), &a_rd_len);
|
---|
544 | if (a_ret != E_OK)
|
---|
545 | goto lb_except;
|
---|
546 | if (a_rd_len < sizeof(a_ecn_prp)) {
|
---|
547 | ECN_DBG_PUT("ecn_itr_nxt() ecn_prp read fault. rd.cur=%d", pk_itr->cur);
|
---|
548 | pk_itr->is_eof = 1; /* 終端に達した時、非0 */
|
---|
549 | a_ret = E_BOVR; /* データ終了 */
|
---|
550 | goto lb_finally;
|
---|
551 | }
|
---|
552 | *p_epc = a_ecn_prp.epc;
|
---|
553 | *p_pdc = a_ecn_prp.pdc;
|
---|
554 |
|
---|
555 | if (0 < a_ecn_prp.pdc) {
|
---|
556 | if (p_edt == NULL) {
|
---|
557 | a_ret = _ecn_fbs_seek_rpos(a_fbs_id, a_ecn_prp.pdc);
|
---|
558 | if (a_ret != E_OK)
|
---|
559 | goto lb_except;
|
---|
560 | }
|
---|
561 | else {
|
---|
562 | /* 付随データを読み取る */
|
---|
563 | a_rd_len = 0;
|
---|
564 | a_ret = _ecn_fbs_get_data(a_fbs_id, p_edt, a_ecn_prp.pdc, &a_rd_len);
|
---|
565 | if (a_ret != E_OK)
|
---|
566 | goto lb_except;
|
---|
567 | if (a_rd_len < (ECN_FBS_SSIZE_T)a_ecn_prp.pdc) {
|
---|
568 | ECN_DBG_PUT("ecn_itr_nxt() edt read fault. rd.cur=%d,epc=0x%02X,pdc=%u",
|
---|
569 | pk_itr->cur, a_ecn_prp.epc , a_ecn_prp.pdc);
|
---|
570 | pk_itr->is_eof = 1; /* 終端に達した時、非0 */
|
---|
571 | a_ret = E_BOVR; /* データ終了 */
|
---|
572 | goto lb_finally;
|
---|
573 | }
|
---|
574 | }
|
---|
575 | }
|
---|
576 | pk_itr->got_ct++;
|
---|
577 |
|
---|
578 | #ifdef ECN_ENA_ITR_NXT_CARP
|
---|
579 | ECN_CAP_PUT("ecn_itr_nxt() read: ct=%d/%d", pk_itr->got_ct, pk_itr->count);
|
---|
580 | #endif
|
---|
581 |
|
---|
582 | lb_finally:
|
---|
583 | /* イテレータのカーソル位置を更新 */
|
---|
584 | pk_itr->cur = a_fbs_id.ptr->hdr.rd;
|
---|
585 |
|
---|
586 | lb_except:
|
---|
587 | /* 元のカーソル位置に戻す */
|
---|
588 | a_fbs_id.ptr->hdr.rd = a_rd_bak;
|
---|
589 | return a_ret;
|
---|
590 | }
|
---|
591 |
|
---|
592 | /*
|
---|
593 | * 応答電文待ちの割り込み送信
|
---|
594 | */
|
---|
595 | ER ecn_brk_wai(const void *p_dat, int fa_datsz)
|
---|
596 | {
|
---|
597 | ER a_ret;
|
---|
598 | ECN_FBS_ID a_fbs_id = { 0 }; /* 要求電文用メモリ */
|
---|
599 |
|
---|
600 | /* 応答電文待ちの割り込み電文作成 */
|
---|
601 | a_ret = _ecn_mk_brk_wai(&a_fbs_id, p_dat, fa_datsz);
|
---|
602 | if (a_ret)
|
---|
603 | return a_ret;
|
---|
604 |
|
---|
605 | /* 割り込み送信 */
|
---|
606 | a_ret = _ecn_tsk_snd_mbx(a_fbs_id, true);
|
---|
607 | if (a_ret) {
|
---|
608 | ECN_DBG_PUT("_ecn_tsk_snd_mbx() result = %d:%s",
|
---|
609 | a_ret, itron_strerror(a_ret));
|
---|
610 | goto lb_except;
|
---|
611 | }
|
---|
612 |
|
---|
613 | /* 正常終了 */
|
---|
614 | return a_ret;
|
---|
615 |
|
---|
616 | lb_except:
|
---|
617 | /* データ作成失敗したら領域解放 */
|
---|
618 | if (a_fbs_id.ptr)
|
---|
619 | _ecn_fbs_del(a_fbs_id);
|
---|
620 |
|
---|
621 | return a_ret;
|
---|
622 | }
|
---|
623 |
|
---|
624 | /*
|
---|
625 | * 割り込みデータの取得
|
---|
626 | */
|
---|
627 | ER ecn_get_brk_dat(T_EDATA *pk_esv, void *p_buf, int fa_bufsz, int *p_datsz)
|
---|
628 | {
|
---|
629 | ECN_FBS_ID a_fbs;
|
---|
630 | ER a_ret;
|
---|
631 | ECN_FBS_SSIZE_T a_len;
|
---|
632 |
|
---|
633 | if (p_datsz)
|
---|
634 | *p_datsz = 0;
|
---|
635 | if (!pk_esv)
|
---|
636 | return E_PAR;
|
---|
637 |
|
---|
638 | a_fbs.ptr = (T_ECN_FST_BLK *)pk_esv;
|
---|
639 | if (a_fbs.ptr->hdr.type != ECN_MSG_USER_BREAK) {
|
---|
640 | ECN_DBG_PUT("ecn_get_brk_dat: fbs-type:%d != ECN_MSG_USER_BREAK",
|
---|
641 | a_fbs.ptr->hdr.type);
|
---|
642 | return E_PAR;
|
---|
643 | }
|
---|
644 |
|
---|
645 | /* 読み取り位置を先頭に戻す */
|
---|
646 | a_ret = _ecn_fbs_set_rpos(a_fbs, 0);
|
---|
647 | if (a_ret) {
|
---|
648 | ECN_DBG_PUT("_ecn_fbs_set_rpos(*, 0) result = %d:%s",
|
---|
649 | a_ret, itron_strerror(a_ret));
|
---|
650 | return a_ret;
|
---|
651 | }
|
---|
652 |
|
---|
653 | /* 付随データを読み込む */
|
---|
654 | if (p_buf && 0 < fa_bufsz) {
|
---|
655 | a_len = 0;
|
---|
656 | a_ret = _ecn_fbs_get_data(a_fbs, p_buf, fa_bufsz, &a_len);
|
---|
657 | if (a_ret || !a_len) {
|
---|
658 | ECN_DBG_PUT("_ecn_fbs_get_data(*, p_buf, fa_bufsz) result = %d:%s",
|
---|
659 | a_ret, itron_strerror(a_ret));
|
---|
660 | return E_PAR;
|
---|
661 | }
|
---|
662 | *p_datsz = a_len;
|
---|
663 | }
|
---|
664 |
|
---|
665 | return E_OK;
|
---|
666 | }
|
---|
667 |
|
---|
668 | #ifndef ECN_USER_DATA_PROP_SET
|
---|
669 | /*
|
---|
670 | * データ設定関数
|
---|
671 | */
|
---|
672 | int ecn_data_prop_set(const EPRPINIB *item, const void *src, int size, bool_t *anno)
|
---|
673 | {
|
---|
674 | if (size > item->eprpsz)
|
---|
675 | size = item->eprpsz;
|
---|
676 |
|
---|
677 | if (*anno)
|
---|
678 | *anno = memcmp((uint8_t *)item->exinf, src, size) != 0;
|
---|
679 |
|
---|
680 | memcpy((uint8_t *)item->exinf, src, size);
|
---|
681 |
|
---|
682 | return size;
|
---|
683 | }
|
---|
684 | #endif
|
---|
685 |
|
---|
686 | #ifndef ECN_USER_DATA_PROP_GET
|
---|
687 | /*
|
---|
688 | * データ取得関数
|
---|
689 | */
|
---|
690 | int ecn_data_prop_get(const EPRPINIB *item, void *dst, int size)
|
---|
691 | {
|
---|
692 | if (size > item->eprpsz)
|
---|
693 | size = item->eprpsz;
|
---|
694 |
|
---|
695 | memcpy(dst, (uint8_t *)item->exinf, size);
|
---|
696 |
|
---|
697 | return size;
|
---|
698 | }
|
---|
699 | #endif
|
---|