2 * Copyright © 2009 Keith Packard <keithp@keithp.com>
4 * This program is free software; you can redistribute it and/or modify
5 * it under the terms of the GNU General Public License as published by
6 * the Free Software Foundation; version 2 of the License.
8 * This program is distributed in the hope that it will be useful, but
9 * WITHOUT ANY WARRANTY; without even the implied warranty of
10 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
11 * General Public License for more details.
13 * You should have received a copy of the GNU General Public License along
14 * with this program; if not, write to the Free Software Foundation, Inc.,
15 * 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA.
23 #define putchar(c) ao_putchar(c)
24 #define getchar() ao_getchar()
28 * Basic I/O functions to support SDCC stdio package
31 #define AO_NUM_STDIOS (HAS_USB + PACKET_HAS_SLAVE + USE_SERIAL_STDIN)
33 __xdata struct ao_stdio ao_stdios[AO_NUM_STDIOS];
34 __data int8_t ao_cur_stdio;
35 __data int8_t ao_num_stdios;
40 if (ao_cur_stdio >= ao_num_stdios || !ao_stdios[ao_cur_stdio].putchar)
43 (*ao_stdios[ao_cur_stdio].putchar)('\r');
44 (*ao_stdios[ao_cur_stdio].putchar)(c);
50 if (ao_stdios[ao_cur_stdio].flush)
51 ao_stdios[ao_cur_stdio].flush();
54 __xdata uint8_t ao_stdin_ready;
57 ao_getchar(void) __reentrant __critical
60 int8_t stdio = ao_cur_stdio;
63 if (stdio < ao_num_stdios) {
64 c = ao_stdios[stdio].pollchar();
65 if (c != AO_READ_AGAIN)
68 if (++stdio >= ao_num_stdios)
70 if (stdio == ao_cur_stdio)
71 ao_sleep(&ao_stdin_ready);
80 return ao_stdios[ao_cur_stdio].echo;
84 ao_add_stdio(char (*pollchar)(void),
85 void (*putchar)(char),
86 void (*flush)(void)) __reentrant
88 if (ao_num_stdios == AO_NUM_STDIOS)
89 ao_panic(AO_PANIC_STDIO);
90 ao_stdios[ao_num_stdios].pollchar = pollchar;
91 ao_stdios[ao_num_stdios].putchar = putchar;
92 ao_stdios[ao_num_stdios].flush = flush;
93 ao_stdios[ao_num_stdios].echo = 1;
94 ao_wakeup(&ao_stdin_ready);
95 return ao_num_stdios++;
100 stdio_put(char c, FILE *stream)
103 if (ao_cur_task && ao_num_stdios)
109 stdio_put('\r', stream);
110 loop_until_bit_is_set(UCSR1A, UDRE1);
118 stdio_get(FILE *stream)
120 return (int) getchar() & 0xff;
123 static FILE mystdout = FDEV_SETUP_STREAM(stdio_put, NULL, _FDEV_SETUP_WRITE);
125 static FILE mystdin = FDEV_SETUP_STREAM(NULL, stdio_get, _FDEV_SETUP_READ);