1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
|
/*
**************************************************************************
*
* Component =
*
* Synopsis = rdbg.c
*
* $Id$
*
**************************************************************************
*/
#include <assert.h>
#include <errno.h>
#include <rtems.h>
#include <rtems/error.h>
#include <rdbg/rdbg.h>
#include <rdbg/servrpc.h>
#include <rtems/rtems_bsdnet.h>
#include <rpc/pmap_clnt.h>
#include <sys/socket.h>
#include <netinet/in.h>
u_short rtemsPort = RTEMS_PORT;
int BackPort = RTEMS_BACK_PORT;
int rtemsActive = 0;
SVCXPRT *rtemsXprt;
int rtemsSock;
char taskName[] = "RTEMS rdbg daemon";
volatile int ExitForSingleStep = 0;
volatile int Continue;
volatile int justSaveContext;
volatile Objects_Id currentTargetThread;
volatile int CannotRestart = 0;
volatile int TotalReboot = 0;
int CONN_LIST_INC = 3;
int PID_LIST_INC = 1;
int TSP_RETRIES = 10;
int
getId ()
{
rtems_id id;
rtems_task_ident (RTEMS_SELF, RTEMS_SEARCH_ALL_NODES, &id);
return (int) (id);
}
static int
rdbgInit (void)
{
int sock;
struct sockaddr_in addr;
sock = socket (AF_INET, SOCK_DGRAM, IPPROTO_UDP);
if (sock == -1) {
printf ("%s: rdbgInit: cannot allocate socket\n", taskName);
return -1;
}
bzero ((void *) &addr, sizeof (struct sockaddr_in));
addr.sin_port = htons (rtemsPort);
if ((bind (sock, (struct sockaddr *) &addr, sizeof (addr))) == -1) {
printf ("%s: rdbgInit: cannot bind socket\n", taskName);
return -2;
}
rtemsXprt = svcudp_create (sock);
if (svcudp_enablecache (rtemsXprt, 1) == 0) {
printf ("%s: rdbgInit: cannot enable rpc cache\n", taskName);
return -3;
}
rtemsSock = sock;
if (!svc_register (rtemsXprt, REMOTEDEB, REMOTEVERS, remotedeb_2, 0)) {
printf (stderr, "unable to register (REMOTEDEB, REMOTEVERS, udp).");
return -4;
}
connect_rdbg_exception ();
return 0;
}
rtems_task
rdbgDaemon (rtems_task_argument argument)
{
svc_run ();
}
void
rtems_rdbg_initialize (void)
{
rtems_name task_name;
rtems_id tid;
rtems_status_code status;
#ifdef DDEBUG
rdb_debug = 1; /* DPRINTF now will display */
#endif
DPRINTF (("%s init starting\n", taskName));
/*
* Print version string
*/
#ifdef DDEBUG
printk ("RDBG v.%d built on [%s %s]\n", SERVER_VERS, __DATE__, __TIME__);
#else
printk ("RDBG v.%d\n", SERVER_VERS);
#endif
/*
* Create socket and init UDP RPC server
*/
if (rdbgInit () != 0)
goto error;
Continue = 1;
justSaveContext = 0;
currentTargetThread = 0;
task_name = rtems_build_name ('R', 'D', 'B', 'G');
if ((status = rtems_task_create (task_name, 5, 24576,
RTEMS_INTERRUPT_LEVEL (0),
RTEMS_DEFAULT_ATTRIBUTES |
RTEMS_SYSTEM_TASK, &tid))
!= RTEMS_SUCCESSFUL) {
printf ("status = %d\n", status);
rtems_panic ("Can't create task.\n");
}
status = rtems_task_start (tid, rdbgDaemon, 0);
return;
error:
printf ("initialization failed.\n");
}
void
setErrno (int error)
{
errno = error;
}
int
getErrno ()
{
return errno;
}
|
