URL https://opencores.org/ocsvn/openrisc_me/openrisc_me/trunk

Subversion Repositories openrisc_me

[/] [openrisc/] [trunk/] [rtos/] [rtems/] [c/] [src/] [lib/] [libbsp/] [m68k/] [ods68302/] [startup/] [debugport.c] - Blame information for rev 30

Go to most recent revision | Details | Compare with Previous | View Log


/*****************************************************************************/
/*
  High Level Debug Port Functions
 
  $Id: debugport.c,v 1.2 2001-09-27 12:00:23 chris Exp $
 
 */
/*****************************************************************************/
 
#include <stdio.h>
#include <stdarg.h>
 
#include "debugport.h"
#include "m68302scc.h"
#include "bsp.h"
 
static int initialised;
 
void debug_port_initialise(void)
{
  scc_initialise(CONSOLE_PORT, CONSOLE_BAUD, FALSE);
#if defined(DEBUG_PORT)
  scc_initialise(DEBUG_PORT, DEBUG_BAUD, FALSE);
#endif
}
 
unsigned char debug_port_status(const unsigned char status)
{
  if (!initialised)
  {
    initialised = 1;
    debug_port_initialise();
  }
 
  return scc_status(CONSOLE_PORT, status);
}
 
unsigned char debug_port_in(void)
{
  if (!initialised)
  {
    initialised = 1;
    debug_port_initialise();
  }
 
  return scc_in(CONSOLE_PORT);
}
 
void debug_port_out(const unsigned char character)
{
  if (!initialised)
  {
    initialised = 1;
    debug_port_initialise();
  }
 
  scc_out(CONSOLE_PORT, character);
}
 
void debug_port_write(const char *buffer)
{
   while (*buffer != '\0')
   {
     debug_port_out(*buffer++);
   }
}
 
void debug_port_write_buffer(const char *buffer, unsigned int size)
{
   unsigned int count;
   for (count = 0; count < size; count++)
   {
     debug_port_out(buffer[count]);
   }
}
 
void debug_port_write_hex_uint(const unsigned int value)
{
   unsigned int bits = sizeof(value) * 8;
   unsigned char c;
 
   do
   {
     bits -= 4;
     c = (unsigned char) ((value >> bits) & 0x0F);
     if (c < 10)
     {
       c += '0';
     }
     else
     {
       c += 'a' - 10;
     }
     debug_port_out((char) c);
   }
   while (bits);
}
 
void debug_port_write_hex_ulong(const unsigned long value)
{
   unsigned int bits = sizeof(value) * 8;
   unsigned char c;
 
   do
   {
     bits -= 4;
     c = (unsigned char) ((value >> bits) & 0x0F);
     if (c < 10)
     {
       c += '0';
     }
     else
     {
       c += 'a' - 10;
     }
     debug_port_out((char) c);
   }
   while (bits);
}
 
#define BUFFER_SIZE (256)
static char buffer[BUFFER_SIZE];
 
void debug_port_printf(const char *format, ...)
{
  va_list args;
  int written;
 
  /*  gain access to the argument list */
  va_start(args, format);
 
  /* set the trap    */
  buffer[BUFFER_SIZE - 2] = '\xAA';
  buffer[BUFFER_SIZE - 1] = '\x55';
 
  /* format the string and send to stdout */
  written = vsprintf(buffer, format, args);
 
  /* try an trap format buffer overflows */
  if ((buffer[BUFFER_SIZE - 2] != '\xAA') ||
      (buffer[BUFFER_SIZE - 1] != '\x55'))
  {
    debug_port_write("debug port buffer overflow, halting...");
    DISABLE_WATCHDOG();
    while (1 == 1);
  }
 
  /* see if an error occurred, if not flush the output buffer */
  if (written != -1)
  {
    debug_port_write_buffer(buffer, written);
  }
}
 
void debug_port_banner(void)
{
#define CARD_LABEL "ods68302-" #VARIANT
 
  debug_port_write("\n\n\r");
  debug_port_write(_Copyright_Notice);
  debug_port_write("\n\r  " CARD_ID "\n\r");
}
 

Line No.	Rev	Author	Line
1	30	unneback	`/*****************************************************************************/`
2			`/*`
3			`High Level Debug Port Functions`
4
5			$Id: debugport.c,v 1.2 2001-09-27 12:00:23 chris Exp $
6
7			`*/`
8			`/*****************************************************************************/`
9
10			`#include <stdio.h>`
11			`#include <stdarg.h>`
12
13			`#include "debugport.h"`
14			`#include "m68302scc.h"`
15			`#include "bsp.h"`
16
17			`static int initialised;`
18
19			`void debug_port_initialise(void)`
20			`{`
21			`scc_initialise(CONSOLE_PORT, CONSOLE_BAUD, FALSE);`
22			`#if defined(DEBUG_PORT)`
23			`scc_initialise(DEBUG_PORT, DEBUG_BAUD, FALSE);`
24			`#endif`
25			`}`
26
27			`unsigned char debug_port_status(const unsigned char status)`
28			`{`
29			`if (!initialised)`
30			`{`
31			`initialised = 1;`
32			`debug_port_initialise();`
33			`}`
34
35			`return scc_status(CONSOLE_PORT, status);`
36			`}`
37
38			`unsigned char debug_port_in(void)`
39			`{`
40			`if (!initialised)`
41			`{`
42			`initialised = 1;`
43			`debug_port_initialise();`
44			`}`
45
46			`return scc_in(CONSOLE_PORT);`
47			`}`
48
49			`void debug_port_out(const unsigned char character)`
50			`{`
51			`if (!initialised)`
52			`{`
53			`initialised = 1;`
54			`debug_port_initialise();`
55			`}`
56
57			`scc_out(CONSOLE_PORT, character);`
58			`}`
59
60			`void debug_port_write(const char *buffer)`
61			`{`
62			`while (*buffer != '\0')`
63			`{`
64			`debug_port_out(*buffer++);`
65			`}`
66			`}`
67
68			`void debug_port_write_buffer(const char *buffer, unsigned int size)`
69			`{`
70			`unsigned int count;`
71			`for (count = 0; count < size; count++)`
72			`{`
73			`debug_port_out(buffer[count]);`
74			`}`
75			`}`
76
77			`void debug_port_write_hex_uint(const unsigned int value)`
78			`{`
79			`unsigned int bits = sizeof(value) * 8;`
80			`unsigned char c;`
81
82			`do`
83			`{`
84			`bits -= 4;`
85			`c = (unsigned char) ((value >> bits) & 0x0F);`
86			`if (c < 10)`
87			`{`
88			`c += '0';`
89			`}`
90			`else`
91			`{`
92			`c += 'a' - 10;`
93			`}`
94			`debug_port_out((char) c);`
95			`}`
96			`while (bits);`
97			`}`
98
99			`void debug_port_write_hex_ulong(const unsigned long value)`
100			`{`
101			`unsigned int bits = sizeof(value) * 8;`
102			`unsigned char c;`
103
104			`do`
105			`{`
106			`bits -= 4;`
107			`c = (unsigned char) ((value >> bits) & 0x0F);`
108			`if (c < 10)`
109			`{`
110			`c += '0';`
111			`}`
112			`else`
113			`{`
114			`c += 'a' - 10;`
115			`}`
116			`debug_port_out((char) c);`
117			`}`
118			`while (bits);`
119			`}`
120
121			`#define BUFFER_SIZE (256)`
122			`static char buffer[BUFFER_SIZE];`
123
124			`void debug_port_printf(const char *format, ...)`
125			`{`
126			`va_list args;`
127			`int written;`
128
129			`/* gain access to the argument list */`
130			`va_start(args, format);`
131
132			`/* set the trap */`
133			`buffer[BUFFER_SIZE - 2] = '\xAA';`
134			`buffer[BUFFER_SIZE - 1] = '\x55';`
135
136			`/* format the string and send to stdout */`
137			`written = vsprintf(buffer, format, args);`
138
139			`/* try an trap format buffer overflows */`
140			`if ((buffer[BUFFER_SIZE - 2] != '\xAA') \|\|`
141			`(buffer[BUFFER_SIZE - 1] != '\x55'))`
142			`{`
143			`debug_port_write("debug port buffer overflow, halting...");`
144			`DISABLE_WATCHDOG();`
145			`while (1 == 1);`
146			`}`
147
148			`/* see if an error occurred, if not flush the output buffer */`
149			`if (written != -1)`
150			`{`
151			`debug_port_write_buffer(buffer, written);`
152			`}`
153			`}`
154
155			`void debug_port_banner(void)`
156			`{`
157			`#define CARD_LABEL "ods68302-" #VARIANT`
158
159			`debug_port_write("\n\n\r");`
160			`debug_port_write(_Copyright_Notice);`
161			`debug_port_write("\n\r " CARD_ID "\n\r");`
162			`}`
163

Browse

Tools

Subversion Repositories openrisc_me

[/] [openrisc/] [trunk/] [rtos/] [rtems/] [c/] [src/] [lib/] [libbsp/] [m68k/] [ods68302/] [startup/] [debugport.c] - Blame information for rev 30