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;
41 (*ao_stdios[ao_cur_stdio].putchar)('\r');
42 (*ao_stdios[ao_cur_stdio].putchar)(c);
48 if (ao_stdios[ao_cur_stdio].flush)
49 ao_stdios[ao_cur_stdio].flush();
52 __xdata uint8_t ao_stdin_ready;
55 ao_getchar(void) __reentrant __critical
58 int8_t stdio = ao_cur_stdio;
61 c = ao_stdios[stdio].pollchar();
62 if (c != AO_READ_AGAIN)
64 if (++stdio == ao_num_stdios)
66 if (stdio == ao_cur_stdio)
67 ao_sleep(&ao_stdin_ready);
76 return ao_stdios[ao_cur_stdio].echo;
80 ao_add_stdio(char (*pollchar)(void),
81 void (*putchar)(char),
82 void (*flush)(void)) __reentrant
84 if (ao_num_stdios == AO_NUM_STDIOS)
85 ao_panic(AO_PANIC_STDIO);
86 ao_stdios[ao_num_stdios].pollchar = pollchar;
87 ao_stdios[ao_num_stdios].putchar = putchar;
88 ao_stdios[ao_num_stdios].flush = flush;
89 ao_stdios[ao_num_stdios].echo = 1;
90 return ao_num_stdios++;
95 stdio_put(char c, FILE *stream)
98 if (ao_cur_task && ao_num_stdios)
104 stdio_put('\r', stream);
105 loop_until_bit_is_set(UCSR1A, UDRE1);
113 stdio_get(FILE *stream)
115 return (int) getchar() & 0xff;
118 static FILE mystdout = FDEV_SETUP_STREAM(stdio_put, NULL, _FDEV_SETUP_WRITE);
120 static FILE mystdin = FDEV_SETUP_STREAM(NULL, stdio_get, _FDEV_SETUP_READ);
127 printf("%d stdios registered\n", ao_num_stdios);