Context Navigation

← Previous Revision
Latest Revision
Next Revision →
Blame
Revision Log

echonet.c@ 101

Last change on this file since 101 was 101, checked in by coas-nagasima, 9 years ago
TOPPERS/uKadecotのソースコードを追加
Property svn:eol-style set to `native` Property svn:keywords set to `Id` Property svn:mime-type set to `text/plain`
File size: 18.7 KB

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

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

Download in other formats:

Original Format