You cannot select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
183 lines
3.4 KiB
C
183 lines
3.4 KiB
C
/**
|
|
* PROM Library for Cisco Systems 3600 Series Routers
|
|
* (C) 2008 Philippe Vachon <philippe@cowpig.ca>
|
|
* -----------------------------------------------------------
|
|
*/
|
|
|
|
/**
|
|
* Calling convention:
|
|
* a0 - syscall number
|
|
* a1 - arg1 ... etc
|
|
* v0 - returned value from syscall
|
|
*/
|
|
|
|
#include <promlib.h>
|
|
|
|
/* putc - Syscall 1
|
|
* output character c to console
|
|
* @param c ASCII number for character
|
|
*/
|
|
void c_putc(const char c)
|
|
{
|
|
asm ( ".set noreorder\n "
|
|
"li $a0, %[syscall]\n"
|
|
"lb $a1, (%[character])\n"
|
|
"syscall\n"
|
|
"nop\n"
|
|
".set reorder\n"
|
|
: /* no output */
|
|
: [character] "r"(&c), [syscall] "g"(PUTC)
|
|
: "a0", "a1"
|
|
);
|
|
}
|
|
|
|
/* puts - wrapper for putc
|
|
* output the string pointed to by s
|
|
* @param s String to be written to the console
|
|
*/
|
|
void c_puts(const char *s)
|
|
{
|
|
while(*s != '\0') {
|
|
c_putc(*(s++));
|
|
}
|
|
}
|
|
|
|
/* putsn - put a string of length n on the console
|
|
* @param s string to be written
|
|
* @param n length
|
|
*/
|
|
void c_putsn(const char *s, int n)
|
|
{
|
|
int i = 0;
|
|
while (*s != '\0' && i != n) {
|
|
c_putc(*(s++));
|
|
i++;
|
|
}
|
|
}
|
|
|
|
|
|
/* getc - Syscall n
|
|
* get one character of input from the console
|
|
* @return ASCII code for character read from console
|
|
*/
|
|
char c_getc(void)
|
|
{
|
|
char c;
|
|
|
|
asm ( ".set noreorder\n "
|
|
"li $a0, %[syscall]\n"
|
|
"syscall\n"
|
|
"nop\n"
|
|
"move %[charout], $v0 \n"
|
|
".set reorder\n"
|
|
: [charout] "=r" (c)
|
|
: [syscall] "g" (GETC)
|
|
: "a0","v0"
|
|
);
|
|
|
|
return c;
|
|
}
|
|
|
|
/* gets - wrapper for getc
|
|
* reads up to n characters into buffer b
|
|
* @param b Buffer to read characters into
|
|
* @param n size of buffer
|
|
* @return the number of characters read into b
|
|
*/
|
|
int c_gets(char *b, int n)
|
|
{
|
|
int i = 0;
|
|
do {
|
|
b[i] = c_getc();
|
|
c_putc(b[i]);
|
|
i++;
|
|
if (b[i - 1] == '\n' || b[i-1] == '\r') {
|
|
break;
|
|
}
|
|
} while (i < n);
|
|
|
|
b[i - 1] = '\0';
|
|
|
|
return i;
|
|
|
|
}
|
|
|
|
/* c_version - get version string
|
|
* @return pointer to version string
|
|
*/
|
|
char *c_verstr(void)
|
|
{
|
|
char *c;
|
|
|
|
asm ( ".set noreorder\n"
|
|
"li $a0, %[syscall]\n"
|
|
"syscall\n"
|
|
"nop\n"
|
|
"move %[result], $v0\n"
|
|
".set reorder\n"
|
|
: [result] "=r" (c)
|
|
: [syscall] "g" (VERSION)
|
|
: "a0", "v0"
|
|
);
|
|
|
|
return c;
|
|
}
|
|
|
|
/* memsz - get total memory size (in bytes)
|
|
* @return the size of the memory installed in the router, in bytes
|
|
*/
|
|
int c_memsz(void)
|
|
{
|
|
int r = 0;
|
|
|
|
asm ( " .set noreorder \n"
|
|
"li $a0, %[syscall]\n"
|
|
"syscall\n"
|
|
"nop\n"
|
|
"move %[result], $v0\n"
|
|
".set reorder\n"
|
|
: [result] "=r" (r)
|
|
: [syscall] "g" (MEMSIZE)
|
|
: "a0","v0"
|
|
);
|
|
|
|
return r;
|
|
}
|
|
|
|
/* timer - get number of ticks from timer
|
|
* @return the value in the timer
|
|
*/
|
|
long c_timer(void)
|
|
{
|
|
long t = 0;
|
|
|
|
asm (" .set noreorder\n"
|
|
"li $a0, %[syscall]\n"
|
|
"syscall\n"
|
|
"nop\n"
|
|
"move %[result], $a0\n"
|
|
".set reorder\n"
|
|
: [result]"=r"(t)
|
|
: [syscall]"g"(TIMER)
|
|
: "a0","v0"
|
|
);
|
|
|
|
return t;
|
|
}
|
|
|
|
/* String length with a maximum length allowed
|
|
* @param s pointer to string
|
|
* @param maxlen maximum length
|
|
*/
|
|
int c_strnlen(const char *s, int maxlen)
|
|
{
|
|
int i = 0;
|
|
if (!s) return 0;
|
|
|
|
while (*(s++) != '\0' && i != maxlen) {
|
|
i++;
|
|
}
|
|
|
|
return i;
|
|
}
|