62 lines
1.3 KiB
C
62 lines
1.3 KiB
C
#ident "$Id: conio.c,v 1.4 2005/01/03 08:23:16 hpa Exp $"
|
|
/* ----------------------------------------------------------------------- *
|
|
*
|
|
* Copyright 2001-2003 H. Peter Anvin - All Rights Reserved
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify
|
|
* it under the terms of the GNU General Public License as published by
|
|
* the Free Software Foundation, Inc., 53 Temple Place Ste 330,
|
|
* Boston MA 02111-1307, USA; either version 2 of the License, or
|
|
* (at your option) any later version; incorporated herein by reference.
|
|
*
|
|
* ----------------------------------------------------------------------- */
|
|
|
|
/*
|
|
* conio.c
|
|
*
|
|
* Output to the screen
|
|
*/
|
|
|
|
#include <com32.h>
|
|
#include <stdarg.h>
|
|
|
|
#define NULL ((void *)0)
|
|
|
|
static inline void memset(void *buf, int ch, unsigned int len)
|
|
{
|
|
asm volatile("cld; rep; stosb"
|
|
: "+D" (buf), "+c" (len) : "a" (ch) : "memory");
|
|
}
|
|
|
|
int putchar(int ch)
|
|
{
|
|
com32sys_t regs;
|
|
|
|
memset(®s, 0, sizeof regs);
|
|
|
|
if ( ch == '\n' ) {
|
|
/* \n -> \r\n */
|
|
putchar('\r');
|
|
}
|
|
|
|
regs.eax.b[1] = 0x02;
|
|
regs.edx.b[0] = ch;
|
|
__com32.cs_intcall(0x21, ®s, NULL);
|
|
|
|
return ch;
|
|
}
|
|
|
|
/* Note: doesn't put '\n' like the stdc version does */
|
|
int puts(const char *s)
|
|
{
|
|
int count = 0;
|
|
|
|
while ( *s ) {
|
|
putchar(*s);
|
|
count++;
|
|
s++;
|
|
}
|
|
|
|
return count;
|
|
}
|