Context Navigation

← Previous Revision
Latest Revision
Next Revision →
Blame
Revision Log

source: UsbWattMeter/trunk/ecnl_lwip/echonet.c@ 164

Last change on this file since 164 was 164, checked in by coas-nagasima, 7 years ago
TOPPERS/ECNLサンプルアプリ「USB充電器電力計」を追加
Property svn:eol-style set to `native` Property svn:keywords set to `Id` Property svn:mime-type set to `text/x-csrc`
File size: 19.0 KB

Line
1	/*
2	* TOPPERS ECHONET Lite Communication Middleware
3	*
4	* Copyright (C) 2014-2016 Cores Co., Ltd. Japan
5	*
6	* ãLì ÒÍCÈºÌ(1)`(4)Ìðð½·êÉÀèC{\tgEF
7	* Ai{\tgEFAðüÏµ½àÌðÜÞDÈº¯¶jðgpE¡»Eü
8	* ÏEÄzziÈºCpÆÄÔj·é±Æð³Åø·éD
9	* (1) {\tgEFAð\[XR[hÌ`Åp·éêÉÍCãLÌì
10	* \¦C±Ìpð¨æÑºLÌ³ÛØKèªC»ÌÜÜÌ`Å\[
11	* XR[hÉÜÜêÄ¢é±ÆD
12	* (2) {\tgEFAðCCu`®ÈÇC¼Ì\tgEFAJÉg
13	* pÅ«é`ÅÄzz·éêÉÍCÄzzÉº¤hL
14	gip
15	* Ò}j
16	AÈÇjÉCãLÌì \¦C±Ìpð¨æÑºL
17	* Ì³ÛØKèðfÚ·é±ÆD
18	* (3) {\tgEFAðC@íÉgÝÞÈÇC¼Ì\tgEFAJÉg
19	* pÅ«È¢`ÅÄzz·éêÉÍCÌ¢¸ê©Ìðð½·±
20	* ÆD
21	* (a) ÄzzÉº¤hL
22	gipÒ}j
23	AÈÇjÉCãLÌ
24	* ì \¦C±Ìpð¨æÑºLÌ³ÛØKèðfÚ·é±ÆD
25	* (b) ÄzzÌ`ÔðCÊÉèßéû@ÉæÁÄCTOPPERSvWFNgÉ
26	* ñ·é±ÆD
27	* (4) {\tgEFAÌpÉæè¼ÚIÜ½ÍÔÚIÉ¶¶é¢©Èé¹
28	* Q©çàCãLì Ò¨æÑTOPPERSvWFNgðÆÓ·é±ÆD
29	* Ü½C{\tgEFAÌ[UÜ½ÍGh[U©çÌ¢©Èé
30	* RÉîÃ¿©çàCãLì Ò¨æÑTOPPERSvWFNgð
31	* ÆÓ·é±ÆD
32	*
33	* {\tgEFAÍC³ÛØÅñ³êÄ¢éàÌÅ éDãLì Ò¨
34	* æÑTOPPERSvWFNgÍC{\tgEFAÉÖµÄCÁèÌgpÚI
35	* ÉÎ·éK«àÜßÄC¢©ÈéÛØàsíÈ¢DÜ½C{\tgEF
36	* AÌpÉæè¼ÚIÜ½ÍÔÚIÉ¶¶½¢©Èé¹QÉÖµÄàC»
37	* ÌÓCðíÈ¢D
38	*
39	* @(#) $Id: echonet.c 164 2016-03-07 11:33:50Z coas-nagasima $
40	*/
41
42	#include <kernel.h>
43	#include <stdio.h>
44	#include <string.h>
45	#include <t_stdlib.h>
46
47	#include "echonet.h"
48	#include "echonet_fbs.h"
49	#include "echonet_task.h"
50	#include "echonet_dbg.h"
51	#include "echonet_agent.h"
52
53	/*
54	* ECHONET LiteT[rXJn
55	*/
56	ER ecn_sta_svc()
57	{
58	return act_tsk(ecn_udp_taskid);
59	}
60
61	/*
62	* ECHONETIuWFNgQÆ
63	* ø
64	* ID fa_eobjid ECHONETIuWFNgID
65	* T_REOBJ *fp_eobj ECHONETIuWFNgÌÝèàeRs[æ
66	*
67	* eobjidÅwèµ½ECHONETIuWFNgÌÝèàeðQÆ·éB
68	* QÆµ½ÝèàeÍpk_eobjÉwèµ½ÉÔ³êéB
69	*/
70	ER ecn_ref_eobj(ID fa_eobjid, T_REOBJ *fp_eobj)
71	{
72	const EOBJINIB *p_obj;
73
74	if (!fp_eobj)
75	return E_PAR; /* p[^G[ */
76
77	if ((fa_eobjid <= 0) \|\| (fa_eobjid > tmax_eobjid))
78	return E_OBJ; /* IuWFNg¢o^ */
79
80	p_obj = &eobjinib_table[fa_eobjid - 1];
81
82	fp_eobj = p_obj;
83
84	return E_OK;
85	}
86
87	/*
88	* ECHONETvpeBQÆ
89	* ø
90	* ID fa_eobjid ECHONETIuWFNgID
91	* uint8_t fa_epc vpeBR[h
92	* T_RPRP *fp_eprp ECHONETIuWFNgÌvpeBÝèàeRs[æ
93	*
94	* eobjidÅwèµ½ECHONETIuWFNgÌAepcÅwèµ½vpeBÌÝèàeðQÆ·éB
95	* QÆµ½ÝèàeÍpk_eprpÉwèµ½ÉÔ³êéB
96	*/
97	ER ecn_ref_eprp(ID fa_eobjid, uint8_t fa_epc, T_RPRP *fp_eprp)
98	{
99	const EOBJINIB *p_obj;
100	const EPRPINIB *p;
101	uint_t i;
102
103	if (!fp_eprp)
104	return E_PAR; /* p[^G[ */
105
106	if ((fa_eobjid <= 0) \|\| (fa_eobjid > tmax_eobjid))
107	return E_OBJ; /* IuWFNg¢o^ */
108
109	p_obj = &eobjinib_table[fa_eobjid - 1];
110
111	/* eojÌÂvpeBú»è`zñ©çõ */
112	p = p_obj->eprp;
113	for (i = 0; i < p_obj->eprpcnt; i++, p++) {
114	if (p->eprpcd != fa_epc)
115	continue;
116	fp_eprp = p;
117	return E_OK;
118	}
119
120	return E_PAR; /* p[^G[ */
121	}
122
123	/*
124	* vpeBl«Ývisvjd¶ì¬
125	* ø
126	* T_EDATA **ppk_esv æ¾µ½d¶Ìi[æ
127	* ID fa_deoj ¶æÌECHONETIuWFNgID
128	* uint8_t fa_epc vpeBR[h
129	* uint8_t fa_pdc vpeBlf[^TCY
130	* const void *p_edt vpeBlf[^
131	*
132	* vpeBl«Ývisvjd¶ðì¬·éB
133	* d¶ÍdeojÅwèµ½ECHONETIuWFNgð¶æÆµA
134	* d¶ÌßÌvpeBlÆµÄAepcÆpdcAp_edtÅwè³ê½
135	* vpeBR[hAf[^TCYAf[^ðd¶ÉÝè·éB
136	* ì¬µ½d¶ÌæªAhXÍ\|C^oRÅÔ³êéB
137	*/
138	ER ecn_esv_seti(T_EDATA **ppk_esv, ID fa_deoj, uint8_t fa_epc, uint8_t fa_pdc,
139	const void *p_edt)
140	{
141	return _ecn_tsk_mk_esv((ECN_FBS_ID *)ppk_esv, (ID)1, fa_deoj, fa_epc, fa_pdc, p_edt, ESV_SET_I);
142	}
143
144	/*
145	* vpeBl«Ývivjd¶ì¬
146	* ø
147	* T_EDATA **ppk_esv æ¾µ½d¶Ìi[æ
148	* ID fa_deoj ¶æÌECHONETIuWFNgID
149	* uint8_t fa_epc vpeBR[h
150	* uint8_t fa_pdc vpeBlf[^TCY
151	* const void *p_edt vpeBlf[^
152	*
153	* vpeBl«Ývivjd¶ðì¬·éB
154	* d¶ÍdeojÅwèµ½ECHONETIuWFNgð¶æÆµA
155	* d¶ÌßÌvpeBlÆµÄAepcÆpdcAp_edtÅwè³ê½
156	* vpeBR[hAf[^TCYAf[^ðd¶ÉÝè·éB
157	* ì¬µ½d¶ÌæªAhXÍ\|C^oRÅÔ³êéB
158	*/
159	ER ecn_esv_setc(T_EDATA **ppk_esv, ID fa_deoj, uint8_t fa_epc, uint8_t fa_pdc,
160	const void *p_edt)
161	{
162	return _ecn_tsk_mk_esv((ECN_FBS_ID *)ppk_esv, (ID)1, fa_deoj, fa_epc, fa_pdc, p_edt, ESV_SET_C);
163	}
164
165	/*
166	* vpeBlÇÝoµvd¶ì¬
167	* ø
168	* T_EDATA **ppk_esv æ¾µ½d¶Ìi[æ
169	* ID fa_deoj ¶æÌECHONETIuWFNgID
170	* uint8_t fa_epc vpeBR[h
171	*
172	* vpeBlÇÝoµvd¶ðì¬·éB
173	* d¶ÍdeojÅwèµ½ECHONETIuWFNgð¶æÆµA
174	* d¶ÌßÌvpeBlÆµÄAepcÅwè³ê½
175	* vpeBR[hðd¶ÉÝè·éB
176	* ì¬µ½d¶ÌæªAhXÍ\|C^oRÅÔ³êéB
177	*/
178	ER ecn_esv_get(T_EDATA **ppk_esv, ID fa_deoj, uint8_t fa_epc)
179	{
180	return _ecn_tsk_mk_esv((ECN_FBS_ID *)ppk_esv, (ID)1, fa_deoj, fa_epc, 0, NULL, ESV_GET);
181	}
182
183	/*
184	* vpeBlÊmvd¶ì¬
185	* ø
186	* T_EDATA **ppk_esv æ¾µ½d¶Ìi[æ
187	* ID fa_deoj ¶æÌECHONETIuWFNgID
188	* uint8_t fa_epc vpeBR[h
189	*
190	* vpeBlÊmvd¶ðì¬·éB
191	* d¶ÍdeojÅwèµ½ECHONETIuWFNgð¶æÆµA
192	* d¶ÌßÌvpeBlÆµÄAepcÅwè³ê½
193	* vpeBR[hðd¶ÉÝè·éB
194	* ì¬µ½d¶ÌæªAhXÍ\|C^oRÅÔ³êéB
195	*/
196	ER ecn_esv_inf_req(T_EDATA **ppk_esv, ID fa_deoj, uint8_t fa_epc)
197	{
198	return _ecn_tsk_mk_esv((ECN_FBS_ID *)ppk_esv, (ID)1, fa_deoj, fa_epc, 0, NULL, ESV_INF_REQ);
199	}
200
201	/*
202	* vpeBl«ÝEÇÝoµvd¶ì¬
203	* ø
204	* T_EDATA **ppk_esv æ¾µ½d¶Ìi[æ
205	* ID fa_deoj ¶æÌECHONETIuWFNgID
206	* uint8_t fa_epc vpeBR[h
207	* uint8_t fa_pdc vpeBlf[^TCY
208	* const void *p_edt vpeBlf[^
209	*
210	* vpeBl«ÝEÇÝoµvd¶ðì¬·éB
211	* d¶ÍdeojÅwèµ½ECHONETIuWFNgð¶æÆµA
212	* d¶ÌßÌvpeBlÆµÄAepcÆpdcAp_edtÅwè³ê½
213	* vpeBR[hAf[^TCYAf[^ðd¶ÉÝè·éB
214	* ì¬µ½d¶ÌæªAhXÍ\|C^oRÅÔ³êéB
215	*/
216	ER ecn_esv_set_get(T_EDATA **ppk_esv, ID fa_deoj, uint8_t fa_epc, uint8_t fa_pdc,
217	const void *p_edt)
218	{
219	return _ecn_tsk_mk_esv((ECN_FBS_ID *)ppk_esv, (ID)1, fa_deoj, fa_epc, fa_pdc, p_edt, ESV_SET_GET);
220	}
221
222	/*
223	* vpeBl«ÝEÇÝoµvd¶ì¬FÜèÔµwè
224	* vpeBl«ÝEÇÝoµvd¶ì¬ÌA«ÝvpeBzñðI¦Ä
225	* ÇÝoµvpeBzñÉÚéÉp¢éB
226	*/
227	ER ecn_trn_set_get(T_EDATA ppk_esv, int p_trn_pos)
228	{
229	ER a_ret;
230
231	if (!ppk_esv)
232	return E_PAR;
233	if (!p_trn_pos)
234	return E_PAR;
235
236	/* vpeBÇÝÝ«ÝÌwbhîñðL^ */
237	p_trn_pos = _ecn_fbs_get_datalen((ECN_FBS_ID *)&ppk_esv);
238
239	/* d¶pÉf[^ÇÁE±Ì_ÅÌd¶vpeBðL^ */
240	a_ret = _ecn_fbs_add_data_ex((ECN_FBS_ID )&ppk_esv, &ppk_esv->hdr.edata.opc, 1);
241	if (a_ret) {
242	ECN_DBG_PUT( "ecn_trn_set_get(): _ecn_fbs_add_data_ex() result = %d:%s", a_ret, itron_strerror(a_ret) );
243	return a_ret;
244	}
245
246	/* d¶vpeBð 0 Éß·i¡ãAI¹wè·éÜÅÍÇÝoµvpeBÉÈéj */
247	ppk_esv->hdr.edata.opc = 0;
248
249	return E_OK;
250	}
251
252	/*
253	* vpeBl«ÝEÇÝoµvd¶ì¬FI¹wè
254	* vpeBl«ÝEÇÝoµvd¶ì¬ÌAÇÝoµvpeBzñðI¦éÉp¢éB
255	*/
256	ER ecn_end_set_get(T_EDATA *ppk_esv, int fa_trn_pos)
257	{
258	ER a_ret;
259	int a_wr_opc;
260	uint8_t a_rd_opc;
261
262	if (!ppk_esv)
263	return E_PAR;
264
265	/* ±Ì_ÅÌd¶vpeB(ÇÝoµvpeB)ðÛ */
266	a_rd_opc = ppk_esv->hdr.edata.opc;
267
268	/* d¶vpeB(«ÝvpeB)ðÛ¶Êu©çÇÝæè */
269	a_wr_opc = _ecn_fbs_peek((ECN_FBS_ID )&ppk_esv, fa_trn_pos);
270	if (a_wr_opc < 0) {
271	ECN_DBG_PUT( "ecn_end_set_get(): _ecn_fbs_peek() result = %d:%s", a_wr_opc, itron_strerror(a_wr_opc) );
272	return a_wr_opc;
273	}
274
275	/* d¶vpeB(«ÝvpeB)ð³ */
276	ppk_esv->hdr.edata.opc = (uint8_t)a_wr_opc;
277
278	/* d¶vpeB(ÇÝoµvpeB)ðÛ¶ÊuÉ«Ý */
279	a_ret = _ecn_fbs_poke((ECN_FBS_ID )&ppk_esv, fa_trn_pos, a_rd_opc);
280	if (a_ret) {
281	ECN_DBG_PUT( "ecn_end_set_get(): _ecn_fbs_poke() result = %d:%s", a_ret, itron_strerror(a_ret) );
282	return a_ret;
283	}
284
285	return E_OK;
286	}
287
288	/*
289	* vpeBlÊmivjd¶ì¬
290	* ø
291	* T_EDATA **ppk_esv æ¾µ½d¶Ìi[æ
292	* ID fa_deoj ¶æÌECHONETIuWFNgID
293	* ID fa_seoj M³ÌECHONETIuWFNgID
294	* uint8_t fa_sepc M³ÌvpeBR[h
295	*/
296	ER ecn_esv_infc(T_EDATA **ppk_esv, ID fa_deoj, ID fa_seoj, uint8_t fa_sepc)
297	{
298	return _ecn_tsk_mk_esv((ECN_FBS_ID *)ppk_esv, fa_seoj, fa_deoj, fa_sepc, 0, NULL, ESV_INFC);
299	}
300
301	/*
302	* vd¶ÖÌvpeBwèÇÁ (vpeBf[^ªtµÈ¢êÉp¢é)
303	*/
304	ER ecn_add_epc(T_EDATA *pk_esv, uint8_t epc)
305	{
306	return ecn_add_edt(pk_esv, epc, 0, 0);
307	}
308
309	/*
310	* vd¶ÖÌvpeBf[^ÇÁ (vpeB¨æÑtf[^ðÇÁ·é)
311	*/
312	ER ecn_add_edt(T_EDATA pk_esv, uint8_t fa_epc, uint8_t fa_pdc, const void p_edt)
313	{
314	ECN_FBS_ID a_fbs_id;
315	ER a_ret;
316	T_ECN_PRP a_ecn_prp;
317
318	if (!pk_esv)
319	return E_PAR; /* æ¾µ½FBS_IDÌi[æªNULL */
320	if (ECHONET_MEMPOOL_BLOCK_SIZE <= fa_pdc)
321	return E_PAR; /* vpeBlTCYªå«·¬é */
322	if (!p_edt && 0 < fa_pdc)
323	return E_PAR; /* vpeBlTCYª1ÈãÈÌÉf[^\|C^ªNULL */
324
325	a_fbs_id.ptr = (T_ECN_FST_BLK *)pk_esv;
326	if (((T_EDATA *)a_fbs_id.ptr)->hdr.edata.opc == 0xFF)
327	return E_PAR; /* vpeBª½·¬é */
328
329	/* vd¶pÉf[^ÇÁ */
330	memset(&a_ecn_prp, 0, sizeof(a_ecn_prp));
331	a_ecn_prp.epc = fa_epc;
332	a_ecn_prp.pdc = fa_pdc;
333	a_ret = _ecn_fbs_add_data_ex(a_fbs_id, &a_ecn_prp, sizeof(a_ecn_prp));
334	if (a_ret) {
335	ECN_DBG_PUT( "ecn_add_edt(): _ecn_fbs_add_data_ex(*, ecn_prp{epc:0x%02X}, %u) result = %d:%s",
336	a_ecn_prp.epc, sizeof(a_ecn_prp),
337	a_ret, itron_strerror(a_ret) );
338	goto lb_except;
339	}
340	if (0 < fa_pdc) {
341	/* tf[^ÇÁ */
342	a_ret = _ecn_fbs_add_data_ex(a_fbs_id, p_edt, fa_pdc);
343	if (a_ret) {
344	ECN_DBG_PUT( "ecn_add_edt(): _ecn_fbs_add_data_ex(*, ecn_prp{epc:0x%02X} edt, %u) result = %d:%s",
345	a_ecn_prp.epc, fa_pdc,
346	a_ret, itron_strerror(a_ret) );
347	goto lb_except;
348	}
349	}
350	/* vpeBCNg */
351	((T_EDATA *)a_fbs_id.ptr)->hdr.edata.opc++;
352
353	lb_except:
354	return a_ret;
355	}
356
357	/*
358	* vd¶ÌM
359	* esvÅwè³ê½vd¶ðM·éB
360	* d¶Éwè³ê½¶æ©çIPAhXðÁèµAUDPpPbgÆµÄM·éB
361	*/
362	ER ecn_snd_esv(T_EDATA *pk_esv)
363	{
364	ECN_FBS_ID a_rsp_fbs;
365	a_rsp_fbs.ptr = (T_ECN_FST_BLK *)pk_esv;
366	return _ecn_tsk_snd_mbx(a_rsp_fbs, true);
367	}
368
369	/*
370	* d¶ÌóMiÒ¿
371	* d¶ðóM·éÌðÒÂB
372	* óMµ½d¶Íppk_esvÅwèµ½\|C^[ÉæªAhXªÔ³êéB
373	* vd¶Ì¶æÌECHONETIuWFNgªlbg[NÉ¶ÝµÈ¢êA
374	* d¶ÍÔ³êÈ¢ÌÅAiÉÒÂ±ÆÉÈéÌÅ^CAEgt«Ì
375	* ecn_trcv_esvðgp·é±Æð§·éB
376	*/
377	ER ecn_rcv_esv(T_EDATA **ppk_esv)
378	{
379	return ecn_trcv_esv(ppk_esv, TMO_FEVR);
380	}
381
382	/*
383	* d¶ÌóMÒ¿^CAEg è
384	* d¶ðóM·éÌðÒÂB
385	* óMµ½d¶Íppk_esvÅwèµ½\|C^[ÉæªAhXªÔ³êéB
386	* tmoÅwè³ê½^CAEgÔªoßµÄàd¶ðóMµÈ¢êA
387	* Ò¿ªð³êAßèlªE_TMOÅÔ³êéB
388	* tmoÉTMO_FEVRðwè·éÆecn_rcv_esvÆ¯¶Ué¢ð·éB
389	* tmoÉ0ðwè·éÆecn_prcv_esvÆ¯¶Ué¢ð·éB
390	*/
391	ER ecn_trcv_esv(T_EDATA **ppk_esv, TMO fa_tmout)
392	{
393	T_MSG *p_msg = 0;
394	ER a_ret;
395
396	if (!ppk_esv)
397	return E_PAR;
398
399	a_ret = trcv_mbx(ecn_api_mailboxid, &p_msg, fa_tmout);
400	if (a_ret != E_OK) {
401	*ppk_esv = NULL;
402	return a_ret;
403	}
404
405	ppk_esv = (T_EDATA )p_msg;
406	return (((T_ECN_FST_BLK *)p_msg)->hdr.type == ECN_MSG_ECHONET) ? E_OK : E_WBLK;
407	}
408
409	/*
410	* d¶ÌóM\|[O
411	* d¶ðóM·éÌðÒÂB
412	* óMµ½d¶Íppk_esvÅwèµ½\|C^[ÉæªAhXªÔ³êéB
413	* d¶ÌóMÌL³É©©íç¸AÒ½¸ÉÖð²¯éB
414	*/
415	ER ecn_prcv_esv(T_EDATA **ppk_esv)
416	{
417	return ecn_trcv_esv(ppk_esv, TMO_POL);
418	}
419
420	/*
421	* d¶Ìjü
422	*/
423	ER ecn_rel_esv(T_EDATA *pk_esv)
424	{
425	ECN_FBS_ID a_fbs;
426	ER a_ret;
427
428	a_fbs.ptr = (T_ECN_FST_BLK *)pk_esv;
429	a_ret = _ecn_fbs_del(a_fbs);
430	return a_ret;
431	}
432
433	/*
434	* d¶ÌM³@íIuWFNgðæ¾·é
435	*/
436	ID ecn_get_eobj(T_EDATA *pk_esv)
437	{
438	const EOBJCB *p_snod;
439	const EOBJINIB *p_sobj = NULL;
440	T_ECN_EDT_HDR *p_esv;
441
442	p_esv = &pk_esv->hdr;
443	p_snod = _ecn_eno_fnd(((T_ECN_FST_BLK *)pk_esv)->hdr.sender.id);
444	if (p_snod != NULL) {
445	/* m[hvt@CÌê */
446	if ((p_esv->edata.seoj.eojx1 == EOJ_X1_PROFILE)
447	&& (p_esv->edata.seoj.eojx2 == EOJ_X2_NODE_PROFILE)) {
448	p_sobj = p_snod->profile;
449	}
450	/* @íIuWFNgÌê */
451	else {
452	p_sobj = _ecn_eoj_fnd(p_snod, &p_esv->edata.seoj);
453	}
454	}
455
456	if (p_sobj == NULL)
457	return EOBJ_NULL;
458	#ifdef ECHONET_CONTROLLER_EXTENTION
459	if (p_sobj->eprpcnt == 0)
460	return ecn_agent_get_eobj(p_sobj);
461	#endif
462	return 1 + (((intptr_t)p_sobj - (intptr_t)eobjinib_table) / sizeof(EOBJINIB));
463	}
464
465	/*
466	* d¶ðÍCe[^[ú»
467	*/
468	ER ecn_itr_ini(T_ENUM_EPC pk_itr, T_EDATA pk_esv)
469	{
470	if (!pk_itr)
471	return E_PAR;
472	if (!pk_esv)
473	return E_PAR;
474
475	memset(pk_itr, 0, sizeof(*pk_itr));
476	pk_itr->pk_esv = pk_esv;
477	pk_itr->count = pk_esv->hdr.edata.opc;
478	/* ¡ÌubNÅÌvpeB */
479	pk_itr->got_ct = 0; /* ¡ÌubNÅAÇÝæÁ½ */
480	pk_itr->next_blk_ct = 0; /* ã±ubN */
481	pk_itr->is_eof = 0; /* I[ÉBµ½Añ0 */
482	pk_itr->cur = offsetof(T_ECN_EDT_HDR, ecn_prp);
483
484	switch (pk_esv->hdr.edata.esv) {
485	case ESV_SET_GET: /* 0x6E vpeBl«ÝEÇÝoµv */
486	case ESV_SET_GET_RES: /* 0x7E vpeBl«ÝEÇÝoµ */
487	case ESV_SET_GET_SNA: /* 0x5E vpeBl«ÝEÇÝoµsÂ */
488	pk_itr->next_blk_ct ++;
489	default:
490	break;
491	}
492
493	return E_OK;
494	}
495
496	/*
497	* d¶ðÍCe[^[CNg
498	*/
499	ER ecn_itr_nxt(T_ENUM_EPC pk_itr, uint8_t p_epc, uint8_t p_pdc, void p_edt)
500	{
501	ECN_FBS_ID a_fbs_id;
502	int a_rd_bak;
503	ER a_ret;
504	ECN_FBS_SSIZE_T a_rd_len;
505	T_ECN_PRP a_ecn_prp;
506
507	if (!pk_itr)
508	return E_PAR;
509	if (!p_epc)
510	return E_PAR;
511	if (!p_pdc)
512	return E_PAR;
513	if (!p_edt)
514	return E_PAR;
515	if (!pk_itr->pk_esv)
516	return E_PAR;
517
518	if (pk_itr->is_eof)
519	return E_BOVR; /* f[^I¹ */
520	if ( pk_itr->count <= pk_itr->got_ct
521	&& pk_itr->next_blk_ct < 1) {
522	pk_itr->is_eof = 1; /* I[ÉBµ½Añ0 */
523	return E_BOVR; /* f[^I¹ */
524	}
525
526	a_fbs_id.ptr = (T_ECN_FST_BLK *)pk_itr->pk_esv;
527
528	/* ³ÌJ[\ÊuðÛ¶µACe[^ÌJ[\ÊuÉ·é */
529	a_rd_bak = a_fbs_id.ptr->hdr.rd;
530	a_fbs_id.ptr->hdr.rd = pk_itr->cur;
531
532	#ifdef ECN_ENA_ITR_NXT_CARP
533	ECN_CAP_PUT( "ecn_itr_nxt() rd.cur=b%dp%d", pk_itr->cur.blk, pk_itr->cur.pos ECN_CAP_PUT(;
534	#endif
535	if (pk_itr->count <= pk_itr->got_ct && 0 < pk_itr->next_blk_ct) {
536	/* ubNÉÚ® */
537	pk_itr->next_blk_ct --;
538	pk_itr->count = 0; /* ¡ÌubNÅÌvpeB */
539	pk_itr->got_ct = 0; /* ¡ÌubNÅAÇÝæÁ½ */
540
541	/* ubNÌvpeBðÇÝæé */
542	a_rd_len = 0;
543	a_ret = _ecn_fbs_get_data(a_fbs_id, &a_ecn_prp.pdc, 1, &a_rd_len);
544	if (a_ret != E_OK)
545	goto lb_except;
546	if (0 < a_rd_len) {
547	pk_itr->count = a_ecn_prp.pdc; /* ¡ÌubNÅÌvpeB */
548	}
549	a_ret = E_BOVR; /* f[^I¹ */
550	goto lb_finally;
551	}
552
553	/* vpeBR[hÆf[^TCYðÇÝæé */
554	memset(&a_ecn_prp, 0, sizeof(a_ecn_prp));
555	a_rd_len = 0;
556	a_ret = _ecn_fbs_get_data(a_fbs_id, &a_ecn_prp, sizeof(a_ecn_prp), &a_rd_len);
557	if (a_ret != E_OK)
558	goto lb_except;
559	if (a_rd_len < sizeof(a_ecn_prp)) {
560	ECN_DBG_PUT( "ecn_itr_nxt() ecn_prp read fault."
561	" rd.cur=%d", pk_itr->cur );
562	pk_itr->is_eof = 1; /* I[ÉBµ½Añ0 */
563	a_ret = E_BOVR; /* f[^I¹ */
564	goto lb_finally;
565	}
566	*p_epc = a_ecn_prp.epc;
567	*p_pdc = a_ecn_prp.pdc;
568
569	if (0 < a_ecn_prp.pdc) {
570	/* tf[^ðÇÝæé */
571	a_rd_len = 0;
572	a_ret = _ecn_fbs_get_data(a_fbs_id, p_edt, a_ecn_prp.pdc, &a_rd_len);
573	if (a_ret != E_OK)
574	goto lb_except;
575	if (a_rd_len < (ECN_FBS_SSIZE_T)a_ecn_prp.pdc) {
576	ECN_DBG_PUT( "ecn_itr_nxt() edt read fault."
577	" rd.cur=%d,epc=0x%02X,pdc=%u", pk_itr->cur, a_ecn_prp.epc , a_ecn_prp.pdc );
578	pk_itr->is_eof = 1; /* I[ÉBµ½Añ0 */
579	a_ret = E_BOVR; /* f[^I¹ */
580	goto lb_finally;
581	}
582	}
583	pk_itr->got_ct++;
584
585	#ifdef ECN_ENA_ITR_NXT_CARP
586	ECN_CAP_PUT( "ecn_itr_nxt() read: ct=%d/%d", pk_itr->got_ct, pk_itr->count ECN_CAP_PUT(;
587	#endif
588
589	lb_finally:
590	/* Ce[^ÌJ[\ÊuðXV */
591	pk_itr->cur = a_fbs_id.ptr->hdr.rd;
592
593	lb_except:
594	/* ³ÌJ[\ÊuÉß· */
595	a_fbs_id.ptr->hdr.rd = a_rd_bak;
596	return a_ret;
597	}
598
599	/*
600	* d¶Ò¿ÌèÝM
601	*/
602	ER ecn_brk_wai(const void *p_dat, int fa_datsz)
603	{
604	ER a_ret;
605	ECN_FBS_ID a_fbs_id = { 0 }; /* vd¶p */
606
607	/* d¶Ò¿ÌèÝd¶ì¬ */
608	a_ret = _ecn_mk_brk_wai(&a_fbs_id, p_dat, fa_datsz);
609	if (a_ret)
610	return a_ret;
611
612	/* èÝM */
613	a_ret = _ecn_tsk_snd_mbx(a_fbs_id, true);
614	if (a_ret) {
615	ECN_DBG_PUT( "_ecn_tsk_snd_mbx() result = %d:%s",
616	a_ret, itron_strerror(a_ret) );
617	goto lb_except;
618	}
619
620	/* ³íI¹ */
621	return a_ret;
622
623	lb_except:
624	/* f[^ì¬¸sµ½çÌæðú */
625	if (a_fbs_id.ptr)
626	_ecn_fbs_del(a_fbs_id);
627
628	return a_ret;
629	}
630
631	/*
632	* èÝf[^Ìæ¾
633	*/
634	ER ecn_get_brk_dat(T_EDATA pk_esv, void p_buf, int fa_bufsz, int *p_datsz)
635	{
636	ECN_FBS_ID a_fbs;
637	ER a_ret;
638	ECN_FBS_SSIZE_T a_len;
639
640	if (p_datsz)
641	*p_datsz = 0;
642	if (!pk_esv)
643	return E_PAR;
644
645	a_fbs.ptr = (T_ECN_FST_BLK *)pk_esv;
646	if (a_fbs.ptr->hdr.type != ECN_MSG_USER_BREAK) {
647	ECN_DBG_PUT( "ecn_get_brk_dat: fbs-type:%d != ECN_MSG_USER_BREAK",
648	a_fbs.ptr->hdr.type );
649	return E_PAR;
650	}
651
652	/* ÇÝæèÊuðæªÉß· */
653	a_ret = _ecn_fbs_set_rpos(a_fbs, 0);
654	if (a_ret) {
655	ECN_DBG_PUT( "_ecn_fbs_set_rpos(*, 0) result = %d:%s",
656	a_ret, itron_strerror(a_ret) );
657	return a_ret;
658	}
659
660	/* tf[^ðÇÝÞ */
661	if (p_buf && 0 < fa_bufsz) {
662	a_len = 0;
663	a_ret = _ecn_fbs_get_data(a_fbs, p_buf, fa_bufsz, &a_len);
664	if (a_ret \|\| !a_len) {
665	ECN_DBG_PUT( "_ecn_fbs_get_data(*, p_buf, fa_bufsz) result = %d:%s",
666	a_ret, itron_strerror(a_ret) );
667	return E_PAR;
668	}
669	*p_datsz = a_len;
670	}
671
672	return E_OK;
673	}
674
675	#ifndef ECN_USER_DATA_PROP_SET
676	/*
677	* f[^ÝèÖ
678	*/
679	int ecn_data_prop_set(const EPRPINIB item, const void src, int size, bool_t *anno)
680	{
681	if (size > item->eprpsz)
682	size = item->eprpsz;
683
684	if (*anno)
685	anno = memcmp((uint8_t )item->exinf, src, size) != 0;
686
687	memcpy((uint8_t *)item->exinf, src, size);
688
689	return size;
690	}
691	#endif
692
693	#ifndef ECN_USER_DATA_PROP_GET
694	/*
695	* f[^æ¾Ö
696	*/
697	int ecn_data_prop_get(const EPRPINIB item, void dst, int size)
698	{
699	if (size > item->eprpsz)
700	size = item->eprpsz;
701
702	memcpy(dst, (uint8_t *)item->exinf, size);
703
704	return size;
705	}
706	#endif

Note: See TracBrowser for help on using the repository browser.

Download in other formats: