Context Navigation

← Previous Revision
Latest Revision
Next Revision →
Blame
Revision Log

source: ssp_qb_r5f100le_cs/trunk/syssvc/serial.c@ 93

Last change on this file since 93 was 93, checked in by nmir-saito, 8 years ago
add Combined package of SSP kernel for QB-R5F100LE-TB(RL78 processor)
File size: 15.7 KB

Line
1	/*
2	* TOPPERS/SSP Kernel
3	* Smallest Set Profile Kernel
4	*
5	* Copyright (C) 2000-2003 by Embedded and Real-Time Systems Laboratory
6	* Toyohashi Univ. of Technology, JAPAN
7	* Copyright (C) 2006-2008 by Embedded and Real-Time Systems Laboratory
8	* Graduate School of Information Science, Nagoya Univ., JAPAN
9	* Copyright (C) 2010-2012 by Meika Sugimoto
10	* Copyright (C) 2015 by Naoki Saito
11	* Nagoya Municipal Industrial Research Institute, JAPAN
12	*
13	* ãLì ÒÍCÈºÌ(1)`(4)Ìðð½·êÉÀèC{\tgEF
14	* Ai{\tgEFAðüÏµ½àÌðÜÞDÈº¯¶jðgpE¡»Eü
15	* ÏEÄzziÈºCpÆÄÔj·é±Æð³Åø·éD
16	* (1) {\tgEFAð\[XR[hÌ`Åp·éêÉÍCãLÌì
17	* \¦C±Ìpð¨æÑºLÌ³ÛØKèªC»ÌÜÜÌ`Å\[
18	* XR[hÉÜÜêÄ¢é±ÆD
19	* (2) {\tgEFAðCCu`®ÈÇC¼Ì\tgEFAJÉg
20	* pÅ«é`ÅÄzz·éêÉÍCÄzzÉº¤hL
21	gip
22	* Ò}j
23	AÈÇjÉCãLÌì \¦C±Ìpð¨æÑºL
24	* Ì³ÛØKèðfÚ·é±ÆD
25	* (3) {\tgEFAðC@íÉgÝÞÈÇC¼Ì\tgEFAJÉg
26	* pÅ«È¢`ÅÄzz·éêÉÍCÌ¢¸ê©Ìðð½·±
27	* ÆD
28	* (a) ÄzzÉº¤hL
29	gipÒ}j
30	AÈÇjÉCãLÌ
31	* ì \¦C±Ìpð¨æÑºLÌ³ÛØKèðfÚ·é±ÆD
32	* (b) ÄzzÌ`ÔðCÊÉèßéû@ÉæÁÄCTOPPERSvWFNgÉ
33	* ñ·é±ÆD
34	* (4) {\tgEFAÌpÉæè¼ÚIÜ½ÍÔÚIÉ¶¶é¢©Èé¹
35	* Q©çàCãLì Ò¨æÑTOPPERSvWFNgðÆÓ·é±ÆD
36	* Ü½C{\tgEFAÌ[UÜ½ÍGh[U©çÌ¢©Èé
37	* RÉîÃ¿©çàCãLì Ò¨æÑTOPPERSvWFNgð
38	* ÆÓ·é±ÆD
39	*
40	* {\tgEFAÍC³ÛØÅñ³êÄ¢éàÌÅ éDãLì Ò¨
41	* æÑTOPPERSvWFNgÍC{\tgEFAÉÖµÄCÁèÌgpÚI
42	* ÉÎ·éK«àÜßÄC¢©ÈéÛØàsíÈ¢DÜ½C{\tgEF
43	* AÌpÉæè¼ÚIÜ½ÍÔÚIÉ¶¶½¢©Èé¹QÉÖµÄàC»
44	* ÌÓCðíÈ¢D
45	*/
46
47	/*
48	* VAC^tF[XhCo
49	*/
50
51	#include <kernel.h>
52	#include "target_syssvc.h"
53	#include "target_serial.h"
54	#include "serial.h"
55	#include "kernel_cfg.h"
56
57	/*
58	* obt@TCYÌftHglÆobt@Ìè`
59	*/
60	#ifndef SERIAL_RCV_BUFSZ1
61	#define SERIAL_RCV_BUFSZ1 64 /* \|[g1ÌóMobt@TCY */
62	#endif /* SERIAL_RCV_BUFSZ1 */
63
64	#ifndef SERIAL_SND_BUFSZ1
65	#define SERIAL_SND_BUFSZ1 256 /* \|[g1ÌMobt@TCY */
66	#endif /* SERIAL_SND_BUFSZ1 */
67
68	static char rcv_buffer1[SERIAL_RCV_BUFSZ1];
69	static char snd_buffer1[SERIAL_SND_BUFSZ1];
70
71	#if TNUM_PORT >= 2 /* \|[g2ÉÖ·éè` */
72
73	#ifndef SERIAL_RCV_BUFSZ2
74	#define SERIAL_RCV_BUFSZ2 64 /* \|[g2ÌóMobt@TCY */
75	#endif /* SERIAL_RCV_BUFSZ2 */
76
77	#ifndef SERIAL_SND_BUFSZ2
78	#define SERIAL_SND_BUFSZ2 64 /* \|[g2ÌMobt@TCY */
79	#endif /* SERIAL_SND_BUFSZ2 */
80
81	static char rcv_buffer2[SERIAL_RCV_BUFSZ2];
82	static char snd_buffer2[SERIAL_SND_BUFSZ2];
83
84	#endif /* TNUM_PORT >= 2 */
85
86	#if TNUM_PORT >= 3 /* \|[g3ÉÖ·éè` */
87
88	#ifndef SERIAL_RCV_BUFSZ3
89	#define SERIAL_RCV_BUFSZ3 64 /* \|[g3ÌóMobt@TCY */
90	#endif /* SERIAL_RCV_BUFSZ3 */
91
92	#ifndef SERIAL_SND_BUFSZ3
93	#define SERIAL_SND_BUFSZ3 64 /* \|[g3ÌMobt@TCY */
94	#endif /* SERIAL_SND_BUFSZ3 */
95
96	static char rcv_buffer3[SERIAL_RCV_BUFSZ3];
97	static char snd_buffer3[SERIAL_SND_BUFSZ3];
98
99	#endif /* TNUM_PORT >= 3 */
100
101	/*
102	* VA\|[gú»ubN
103	*/
104	typedef struct serial_port_initialization_block {
105	uint_t rcv_bufsz; /* óMobt@TCY */
106	char rcv_buffer; / óMobt@ */
107	uint_t snd_bufsz; /* Mobt@TCY */
108	char snd_buffer; / Mobt@ */
109	} SPINIB;
110
111	static const SPINIB spinib_table[TNUM_PORT] = {
112	{ SERIAL_RCV_BUFSZ1, rcv_buffer1,
113	SERIAL_SND_BUFSZ1, snd_buffer1 },
114	#if TNUM_PORT >= 2
115	{ SERIAL_RCV_BUFSZ2, rcv_buffer2,
116	SERIAL_SND_BUFSZ2, snd_buffer2 },
117	#endif /* TNUM_PORT >= 2 */
118	#if TNUM_PORT >= 3
119	{ SERIAL_RCV_BUFSZ3, rcv_buffer3,
120	SERIAL_SND_BUFSZ3, snd_buffer3 },
121	#endif /* TNUM_PORT >= 3 */
122	};
123
124	/*
125	* VA\|[gÇubN
126	*/
127	typedef struct serial_port_control_block {
128	const SPINIB p_spinib; / VA\|[gú»ubN */
129	SIOPCB p_siopcb; / VAI/O\|[gÇubN */
130	bool_t openflag; /* I[vÏÝtO */
131	bool_t errorflag; /* G[tO */
132	uint_t ioctl; /* ®ì§äÌÝèl */
133
134	uint_t rcv_read_ptr; /* óMobt@Çoµ\|C^ */
135	uint_t rcv_write_ptr; /* óMobt@Ý\|C^ */
136	uint_t rcv_count; /* óMobt@Ì¶ */
137
138	uint_t snd_read_ptr; /* Mobt@Çoµ\|C^ */
139	uint_t snd_write_ptr; /* Mobt@Ý\|C^ */
140	uint_t snd_count; /* Mobt@Ì¶ */
141	} SPCB;
142
143	static SPCB spcb_table[TNUM_PORT];
144
145	/*
146	* VA\|[gID©çVA\|[gÇubNðæèo·½ßÌ}N
147	*/
148	#define INDEX_PORT(portid) ((uint_t)((portid) - 1))
149	#define get_spcb(portid) (&(spcb_table[INDEX_PORT(portid)]))
150
151	/*
152	* \|C^ÌCNg
153	*/
154	#define INC_PTR(ptr, bufsz) { if (++(ptr) == (bufsz)) { (ptr) = 0; }}
155
156	/*
157	* T[rXR[Äoµ}N
158	*
159	* T[rXR[ÄoµðÜÞ®expð]¿µCÔlªG[iÌljÌê
160	* ÉÍCercÉercd_expð]¿µ½lðãüµCerror_exitÉgoto·éD
161	*/
162	#define SVC(exp, ercd_exp) \
163	{ if ((exp) < 0) { ercd = (ercd_exp); goto error_exit; }}
164
165	/*
166	* E_SYSG[Ì¶¬
167	*/
168	static ER
169	gen_ercd_sys(SPCB *p_spcb)
170	{
171	p_spcb->errorflag = true;
172	return(E_SYS);
173	}
174
175
176	/*
177	* VAC^tF[XhCoÌú»[`
178	*/
179	void
180	serial_initialize(intptr_t exinf)
181	{
182	uint_t i;
183	SPCB *p_spcb;
184
185	for (i = 0; i < TNUM_PORT; i++) {
186	p_spcb = &(spcb_table[i]);
187	p_spcb->p_spinib = &(spinib_table[i]);
188	p_spcb->openflag = false;
189	}
190	}
191
192	/*
193	* VAC^[tF[XhCoÌI¹[`
194	*/
195
196	void
197	serial_terminate(intptr_t exinf)
198	{
199	uint_t i;
200	SPCB *p_spcb;
201
202	/* obt@ÉcÁÄ¢éSÄÌ¶ðoÍ·é */
203	for (i = 0; i < TNUM_PORT; i++) {
204	p_spcb = &(spcb_table[i]);
205
206	while(p_spcb->snd_count != 0U)
207	{
208	if(sio_snd_chr(p_spcb->p_siopcb,
209	p_spcb->p_spinib->snd_buffer[p_spcb->snd_read_ptr]) == true)
210	{
211	INC_PTR(p_spcb->snd_read_ptr, p_spcb->p_spinib->snd_bufsz);
212	p_spcb->snd_count--;
213	}
214	}
215	}
216
217	}
218
219	/*
220	* VA\|[gÌI[viT[rXR[j
221	*/
222	ER
223	serial_opn_por(ID portid)
224	{
225	SPCB *p_spcb;
226	ER ercd;
227
228	if (sns_dpn()) { /* ReLXgÌ`FbN */
229	return(E_CTX);
230	}
231	if (!(1 <= portid && portid <= TNUM_PORT)) {
232	return(E_ID); /* \|[gÔÌ`FbN */
233	}
234	p_spcb = get_spcb(portid);
235
236	SVC(dis_dsp(), gen_ercd_sys(p_spcb));
237	if (p_spcb->openflag) { /* I[vÏÝ©Ì`FbN */
238	ercd = E_OBJ;
239	}
240	else {
241	/*
242	* ÏÌú»
243	*/
244	p_spcb->ioctl = (IOCTL_ECHO \| IOCTL_CRLF);
245
246	p_spcb->rcv_read_ptr = p_spcb->rcv_write_ptr = 0U;
247	p_spcb->rcv_count = 0U;
248
249	p_spcb->snd_read_ptr = p_spcb->snd_write_ptr = 0U;
250	p_spcb->snd_count = 0U;
251
252	/*
253	* ±êÈ~CÝðÖ~·éD
254	*/
255	if (loc_cpu() < 0) {
256	ercd = E_SYS;
257	goto error_exit_enadsp;
258	}
259
260	/*
261	* n[hEFAË¶ÌI[v
262	*/
263	p_spcb->p_siopcb = sio_opn_por(portid, (intptr_t) p_spcb);
264
265	/*
266	* óMÊmR[obNðÂ·éD
267	*/
268	sio_ena_cbr(p_spcb->p_siopcb, SIO_RDY_RCV);
269	p_spcb->openflag = true;
270	p_spcb->errorflag = false;
271
272	if (unl_cpu() < 0) {
273	p_spcb->errorflag = true;
274	ercd = E_SYS;
275	goto error_exit_enadsp;
276	}
277	ercd = E_OK;
278	}
279
280	error_exit_enadsp:
281	SVC(ena_dsp(), gen_ercd_sys(p_spcb));
282
283	error_exit:
284	return(ercd);
285	}
286
287	/*
288	* VA\|[gÌN[YiT[rXR[j
289	*/
290	ER
291	serial_cls_por(ID portid)
292	{
293	SPCB *p_spcb;
294	ER ercd;
295	bool_t eflag = false;
296
297	if (sns_dpn()) { /* ReLXgÌ`FbN */
298	return(E_CTX);
299	}
300	if (!(1 <= portid && portid <= TNUM_PORT)) {
301	return(E_ID); /* \|[gÔÌ`FbN */
302	}
303	p_spcb = get_spcb(portid);
304
305	SVC(dis_dsp(), gen_ercd_sys(p_spcb));
306	if (!(p_spcb->openflag)) { /* I[vÏÝ©Ì`FbN */
307	ercd = E_OBJ;
308	}
309	else {
310	/*
311	* n[hEFAË¶ÌN[Y
312	*/
313	if (loc_cpu() < 0) {
314	eflag = true;
315	}
316	sio_cls_por(p_spcb->p_siopcb);
317	p_spcb->openflag = false;
318	if (unl_cpu() < 0) {
319	eflag = true;
320	}
321
322	/*
323	* G[R[hÌÝè
324	*/
325	if (eflag) {
326	ercd = gen_ercd_sys(p_spcb);
327	}
328	else {
329	ercd = E_OK;
330	}
331	}
332	SVC(ena_dsp(), gen_ercd_sys(p_spcb));
333
334	error_exit:
335	return(ercd);
336	}
337
338	/*
339	* VA\|[gÖÌ¶M
340	*
341	* p_spcbÅwè³êéVAI/O\|[gÉÎµÄC¶cðM·éD¶
342	* ðMWX^É¢ê½êÉÍtrueðÔ·D»¤ÅÈ¢êÉÍCM
343	* WX^ªó¢½±ÆðÊm·éR[obNÖðÂµCfalseðÔ·D
344	* ±ÌÖÍCCPUbNóÔÅÄÑo³êéD
345	*/
346	Inline bool_t
347	serial_snd_chr(SPCB *p_spcb, char c)
348	{
349	if (sio_snd_chr(p_spcb->p_siopcb, c)) {
350	return(true);
351	}
352	else {
353	sio_ena_cbr(p_spcb->p_siopcb, SIO_RDY_SND);
354	return(false);
355	}
356	}
357
358	/*
359	* VA\|[gÖÌ1¶M
360	* wè³ê½¶ÌMðÝé.
361	* foCXÖÌMª¬÷µ½êÜ½Íobt@Éó«ª èi[Å«½êÍ false,
362	* obt@ªtÅi[Å«È©Á½êÍ true ðÔ·D
363	* »êÈOÌG[ª¶µ½êÍ ER ^ÌG[R[hðÔ·D
364	*/
365	static ER_BOOL
366	serial_wri_chr(SPCB *p_spcb, char c)
367	{
368	bool_t buffer_full;
369	ER ercd, rercd;
370
371	/*
372	* LFÌOÉCRðM·éD
373	* ½¾µC1¶ÈºÌó«µ©È¢êÍobt@tÆÝÈµCMµÈ¢D
374	*/
375	if (c == '\n' && (p_spcb->ioctl & IOCTL_CRLF) != 0U) {
376	if(p_spcb->snd_count + 1U < p_spcb->p_spinib->snd_bufsz) {
377	SVC(rercd = serial_wri_chr(p_spcb, '\r'), rercd);
378	}
379	else {
380	return (ER_BOOL) true;
381	}
382	}
383
384	SVC(loc_cpu(), gen_ercd_sys(p_spcb));
385	if ((p_spcb->snd_count == 0U) && serial_snd_chr(p_spcb, c)) {
386	/*
387	* VAI/OfoCXÌMWX^É¶ðüêé±ÆÉ¬÷µ
388	* ½êD
389	*/
390	buffer_full = false;
391	}
392	else {
393	/*
394	* ó«ª êÎCMobt@É¶ðüêéD
395	* ó«ªÈ¢êCMµÈ¢D
396	*/
397	if(p_spcb->snd_count < p_spcb->p_spinib->snd_bufsz) {
398	p_spcb->p_spinib->snd_buffer[p_spcb->snd_write_ptr] = c;
399	INC_PTR(p_spcb->snd_write_ptr, p_spcb->p_spinib->snd_bufsz);
400	p_spcb->snd_count++;
401	buffer_full = false;
402	}
403	else {
404	buffer_full = true;
405	}
406	}
407
408	SVC(unl_cpu(), gen_ercd_sys(p_spcb));
409	ercd = (ER_BOOL) buffer_full;
410
411	error_exit:
412	return(ercd);
413	}
414
415	bool_t
416	serial_rcvbuf_empty(SPCB *p_spcb)
417	{
418	return (p_spcb->rcv_count == 0u);
419	}
420
421	/*
422	* VA\|[gÖÌ¶ñMiT[rXR[j
423	*/
424	ER_UINT
425	serial_wri_dat(ID portid, const char *buf, uint_t len)
426	{
427	SPCB *p_spcb;
428	bool_t buffer_full;
429	uint_t wricnt = 0U;
430	ER ercd, rercd;
431
432	if (sns_dpn()) { /* ReLXgÌ`FbN */
433	return(E_CTX);
434	}
435	if (!(1 <= portid && portid <= TNUM_PORT)) {
436	return(E_ID); /* \|[gÔÌ`FbN */
437	}
438
439	p_spcb = get_spcb(portid);
440	if (!(p_spcb->openflag)) { /* I[vÏÝ©Ì`FbN */
441	return(E_OBJ);
442	}
443	if (p_spcb->errorflag) { /* G[óÔ©Ì`FbN */
444	return(E_SYS);
445	}
446
447	/*
448	* len ÜÅ1¶¸ÂMðÝéD
449	* rÅobt@tÉÈÁ½çf·éD
450	*/
451	SVC((rercd = dis_dsp()) , rercd);
452	for(wricnt = 0U; wricnt < len; wricnt++) {
453	SVC(rercd = serial_wri_chr(p_spcb, *buf++), rercd);
454	buffer_full = (bool_t)rercd;
455	if(buffer_full) {
456	break;
457	}
458	}
459	SVC((rercd = ena_dsp()) , rercd);
460
461	ercd = E_OK;
462	error_exit:
463	return(wricnt > 0U ? (ER_UINT) wricnt : ercd);
464	}
465
466	/*
467	* VA\|[g©çÌ1¶óM
468	* ¶ÌóMðÝé.
469	* obt@Éf[^ª¶ÝµCæ¾Å«½êÍ false,
470	* obt@ªóÅæ¾Å«È©Á½êÍ true ðÔ·D
471	* »êÈOÌG[ª¶µ½êÍ ER ^ÌG[R[hðÔ·D
472	*/
473	static ER_BOOL
474	serial_rea_chr(SPCB p_spcb, char p_c)
475	{
476	bool_t buffer_empty;
477	ER ercd;
478
479	SVC(loc_cpu(), gen_ercd_sys(p_spcb));
480
481	/*
482	* f[^ª¶Ý·êÎCóMobt@©ç¶ðæèo·D
483	* È¯êÎæèo³È¢D
484	*/
485	if(p_spcb->rcv_count > 0U) {
486	*p_c = p_spcb->p_spinib->rcv_buffer[p_spcb->rcv_read_ptr];
487	INC_PTR(p_spcb->rcv_read_ptr, p_spcb->p_spinib->rcv_bufsz);
488	p_spcb->rcv_count--;
489	buffer_empty = false;
490	}
491	else {
492	buffer_empty = true;
493	}
494
495	SVC(unl_cpu(), gen_ercd_sys(p_spcb));
496	ercd = (ER_BOOL) buffer_empty;
497
498	error_exit:
499	return(ercd);
500	}
501
502	/*
503	* VA\|[g©çÌ¶ñóMiT[rXR[j
504	*/
505	ER_UINT
506	serial_rea_dat(ID portid, char *buf, uint_t len)
507	{
508	SPCB *p_spcb;
509	bool_t buffer_empty;
510	uint_t reacnt = 0U;
511	char c = '\0'; /* RpCÌxð}~·é½ßÉú»·é */
512	ER ercd, rercd;
513
514	if (sns_dpn()) { /* ReLXgÌ`FbN */
515	return(E_CTX);
516	}
517	if (!(1 <= portid && portid <= TNUM_PORT)) {
518	return(E_ID); /* \|[gÔÌ`FbN */
519	}
520
521	p_spcb = get_spcb(portid);
522	if (!(p_spcb->openflag)) { /* I[vÏÝ©Ì`FbN */
523	return(E_OBJ);
524	}
525	if (p_spcb->errorflag) { /* G[óÔ©Ì`FbN */
526	return(E_SYS);
527	}
528
529	/*
530	* len ÜÅóMðÝéD
531	* obt@ªóÅÇÝo¹È©Á½êÍf·é
532	*/
533	SVC((rercd = dis_dsp()) , rercd);
534	for(reacnt = 0U; reacnt < len; reacnt++) {
535	SVC(rercd = serial_rea_chr(p_spcb, &c), rercd);
536	buffer_empty = (bool_t)rercd;
537
538	if(buffer_empty) {
539	break;
540	}
541	else {
542	/*
543	* GR[obND
544	*/
545	if ((p_spcb->ioctl & IOCTL_ECHO) != 0U) {
546	SVC(rercd = serial_wri_chr(p_spcb, c), rercd);
547	}
548	*buf++ = c;
549	}
550	}
551	SVC((rercd = ena_dsp()) , rercd);
552
553	ercd = E_OK;
554	error_exit:
555	return(reacnt > 0U ? (ER_UINT) reacnt : ercd);
556	}
557
558	/*
559	* VA\|[gÌ§äiT[rXR[j
560	*/
561	ER
562	serial_ctl_por(ID portid, uint_t ioctl)
563	{
564	SPCB *p_spcb;
565
566	if (sns_dpn()) { /* ReLXgÌ`FbN */
567	return(E_CTX);
568	}
569	if (!(1 <= portid && portid <= TNUM_PORT)) {
570	return(E_ID); /* \|[gÔÌ`FbN */
571	}
572
573	p_spcb = get_spcb(portid);
574	if (!(p_spcb->openflag)) { /* I[vÏÝ©Ì`FbN */
575	return(E_OBJ);
576	}
577	if (p_spcb->errorflag) { /* G[óÔ©Ì`FbN */
578	return(E_SYS);
579	}
580
581	p_spcb->ioctl = ioctl;
582	return(E_OK);
583	}
584
585	/*
586	* VA\|[g©çÌMÂ\R[obN
587	*/
588	void
589	sio_irdy_snd(intptr_t exinf)
590	{
591	SPCB *p_spcb;
592
593	p_spcb = (SPCB *) exinf;
594
595	if (p_spcb->snd_count > 0U) {
596	/*
597	* Mobt@©ç¶ðæèoµÄM·éD
598	*/
599	(void) sio_snd_chr(p_spcb->p_siopcb,
600	p_spcb->p_spinib->snd_buffer[p_spcb->snd_read_ptr]);
601	INC_PTR(p_spcb->snd_read_ptr, p_spcb->p_spinib->snd_bufsz);
602	p_spcb->snd_count--;
603	}
604	else {
605	/*
606	* M·×«¶ªÈ¢êÍCMÂ\R[obNðÖ~·éD
607	*/
608	sio_dis_cbr(p_spcb->p_siopcb, SIO_RDY_SND);
609	}
610	}
611
612	/*
613	* VA\|[g©çÌóMÊmR[obN
614	*/
615	void
616	sio_irdy_rcv(intptr_t exinf)
617	{
618	SPCB *p_spcb;
619	char c;
620
621	p_spcb = (SPCB *) exinf;
622	c = (char) sio_rcv_chr(p_spcb->p_siopcb);
623
624	if (p_spcb->rcv_count != p_spcb->p_spinib->rcv_bufsz) {
625	/*
626	* óMµ½¶ðóMobt@ÉüêéD
627	* obt@tÌêCóMµ½¶ðÌÄéD
628	*/
629	p_spcb->p_spinib->rcv_buffer[p_spcb->rcv_write_ptr] = c;
630	INC_PTR(p_spcb->rcv_write_ptr, p_spcb->p_spinib->rcv_bufsz);
631	p_spcb->rcv_count++;
632	}
633	}
634
635	/*
636	* VAC^tF[XhCo©çÌ¢M¶Ìæoµ
637	*/
638	bool_t
639	serial_get_chr(ID portid, char *p_c)
640	{
641	SPCB *p_spcb;
642
643	if (1 <= portid && portid <= TNUM_PORT) { /* \|[gÔÌ`FbN */
644	p_spcb = get_spcb(portid);
645	if (p_spcb->openflag) { /* I[vÏÝ©Ì`FbN */
646	if (p_spcb->snd_count > 0U) {
647	*p_c = p_spcb->p_spinib->snd_buffer[p_spcb->snd_read_ptr];
648	INC_PTR(p_spcb->snd_read_ptr, p_spcb->p_spinib->snd_bufsz);
649	p_spcb->snd_count--;
650	return(true);
651	}
652	}
653	}
654	return(false);
655	}

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

Download in other formats: