234 lines
6.8 KiB
C
234 lines
6.8 KiB
C
#include "syslib.h"
|
|
#include <assert.h>
|
|
#include <minix/sysutil.h>
|
|
#include <stdio.h>
|
|
|
|
/* Self variables. */
|
|
#define SEF_SELF_NAME_MAXLEN 20
|
|
PUBLIC char sef_self_name[SEF_SELF_NAME_MAXLEN];
|
|
PUBLIC endpoint_t sef_self_endpoint;
|
|
|
|
/* Debug. */
|
|
#define SEF_DEBUG_HEADER_MAXLEN 32
|
|
PRIVATE time_t sef_debug_boottime = 0;
|
|
PRIVATE u32_t sef_debug_system_hz = 0;
|
|
PRIVATE time_t sef_debug_time_sec = 0;
|
|
PRIVATE time_t sef_debug_time_us = 0;
|
|
PRIVATE char sef_debug_header_buff[SEF_DEBUG_HEADER_MAXLEN];
|
|
FORWARD _PROTOTYPE( void sef_debug_refresh_params, (void) );
|
|
PUBLIC _PROTOTYPE( char* sef_debug_header, (void) );
|
|
|
|
/* SEF Init prototypes. */
|
|
EXTERN _PROTOTYPE( int do_sef_rs_init, (void) );
|
|
EXTERN _PROTOTYPE( int do_sef_init_request, (message *m_ptr) );
|
|
|
|
/* SEF Ping prototypes. */
|
|
EXTERN _PROTOTYPE( int do_sef_ping_request, (message *m_ptr) );
|
|
|
|
/* SEF Live update prototypes. */
|
|
EXTERN _PROTOTYPE( void do_sef_lu_before_receive, (void) );
|
|
EXTERN _PROTOTYPE( int do_sef_lu_request, (message *m_ptr) );
|
|
|
|
/* SEF Signal prototypes. */
|
|
EXTERN _PROTOTYPE( int do_sef_signal_request, (message *m_ptr) );
|
|
|
|
/*===========================================================================*
|
|
* sef_startup *
|
|
*===========================================================================*/
|
|
PUBLIC void sef_startup()
|
|
{
|
|
/* SEF startup interface for system services. */
|
|
int r, status;
|
|
|
|
/* Get information about self. */
|
|
r = sys_whoami(&sef_self_endpoint, sef_self_name, SEF_SELF_NAME_MAXLEN);
|
|
if ( r != OK) {
|
|
sef_self_endpoint = SELF;
|
|
sprintf(sef_self_name, "%s", "Unknown");
|
|
}
|
|
|
|
#if INTERCEPT_SEF_INIT_REQUESTS
|
|
/* Intercept SEF Init requests. */
|
|
if(sef_self_endpoint == RS_PROC_NR) {
|
|
if((r = do_sef_rs_init()) != OK) {
|
|
panic("unable to complete init: %d", r);
|
|
}
|
|
}
|
|
else {
|
|
message m;
|
|
|
|
r = receive(RS_PROC_NR, &m, &status);
|
|
if(r != OK) {
|
|
panic("unable to receive from RS: %d", r);
|
|
}
|
|
if(IS_SEF_INIT_REQUEST(&m)) {
|
|
if((r = do_sef_init_request(&m)) != OK) {
|
|
panic("unable to process init request: %d", r);
|
|
}
|
|
}
|
|
else {
|
|
panic("got an unexpected message type %d", m.m_type);
|
|
}
|
|
}
|
|
#endif
|
|
}
|
|
|
|
/*===========================================================================*
|
|
* sef_receive_status *
|
|
*===========================================================================*/
|
|
PUBLIC int sef_receive_status(endpoint_t src, message *m_ptr, int *status_ptr)
|
|
{
|
|
/* SEF receive() interface for system services. */
|
|
int r, status;
|
|
|
|
while(TRUE) {
|
|
|
|
#if INTERCEPT_SEF_LU_REQUESTS
|
|
/* Handle SEF Live update before receive events. */
|
|
do_sef_lu_before_receive();
|
|
#endif
|
|
|
|
/* Receive and return in case of error. */
|
|
r = receive(src, m_ptr, &status);
|
|
if(status_ptr) *status_ptr = status;
|
|
if(r != OK) {
|
|
return r;
|
|
}
|
|
|
|
#if INTERCEPT_SEF_PING_REQUESTS
|
|
/* Intercept SEF Ping requests. */
|
|
if(IS_SEF_PING_REQUEST(m_ptr, status)) {
|
|
if(do_sef_ping_request(m_ptr) == OK) {
|
|
continue;
|
|
}
|
|
}
|
|
#endif
|
|
|
|
#if INTERCEPT_SEF_LU_REQUESTS
|
|
/* Intercept SEF Live update requests. */
|
|
if(IS_SEF_LU_REQUEST(m_ptr, status)) {
|
|
if(do_sef_lu_request(m_ptr) == OK) {
|
|
continue;
|
|
}
|
|
}
|
|
#endif
|
|
|
|
#if INTERCEPT_SEF_SIGNAL_REQUESTS
|
|
/* Intercept SEF Signal requests. */
|
|
if(IS_SEF_SIGNAL_REQUEST(m_ptr, status)) {
|
|
if(do_sef_signal_request(m_ptr) == OK) {
|
|
continue;
|
|
}
|
|
}
|
|
#endif
|
|
|
|
/* If we get this far, this is not a valid SEF request, return and
|
|
* let the caller deal with that.
|
|
*/
|
|
break;
|
|
}
|
|
|
|
return r;
|
|
}
|
|
|
|
/*===========================================================================*
|
|
* sef_exit *
|
|
*===========================================================================*/
|
|
PUBLIC void sef_exit(int status)
|
|
{
|
|
/* System services use a special version of exit() that generates a
|
|
* self-termination signal.
|
|
*/
|
|
message m;
|
|
|
|
/* Ask the kernel to exit. */
|
|
sys_exit();
|
|
|
|
/* If sys_exit() fails, this is not a system service. Exit through PM. */
|
|
m.m1_i1 = status;
|
|
_syscall(PM_PROC_NR, EXIT, &m);
|
|
|
|
/* If everything else fails, hang. */
|
|
printf("Warning: system service %d couldn't exit\n", sef_self_endpoint);
|
|
for(;;) { }
|
|
}
|
|
|
|
/*===========================================================================*
|
|
* _exit *
|
|
*===========================================================================*/
|
|
PUBLIC void _exit(int status)
|
|
{
|
|
/* Make exit() an alias for sef_exit() for system services. */
|
|
sef_exit(status);
|
|
}
|
|
|
|
/*===========================================================================*
|
|
* __exit *
|
|
*===========================================================================*/
|
|
PUBLIC void __exit(int status)
|
|
{
|
|
/* Make exit() an alias for sef_exit() for system services. */
|
|
sef_exit(status);
|
|
}
|
|
|
|
/*===========================================================================*
|
|
* sef_debug_refresh_params *
|
|
*===========================================================================*/
|
|
PRIVATE void sef_debug_refresh_params(void)
|
|
{
|
|
/* Refresh SEF debug params. */
|
|
clock_t uptime;
|
|
int r;
|
|
|
|
/* Get boottime the first time. */
|
|
if(!sef_debug_boottime) {
|
|
r = sys_times(NONE, NULL, NULL, NULL, &sef_debug_boottime);
|
|
if ( r != OK) {
|
|
sef_debug_boottime = -1;
|
|
}
|
|
}
|
|
|
|
/* Get system hz the first time. */
|
|
if(!sef_debug_system_hz) {
|
|
r = sys_getinfo(GET_HZ, &sef_debug_system_hz,
|
|
sizeof(sef_debug_system_hz), 0, 0);
|
|
if ( r != OK) {
|
|
sef_debug_system_hz = -1;
|
|
}
|
|
}
|
|
|
|
/* Get uptime. */
|
|
uptime = -1;
|
|
if(sef_debug_boottime!=-1 && sef_debug_system_hz!=-1) {
|
|
r = sys_times(NONE, NULL, NULL, &uptime, NULL);
|
|
if ( r != OK) {
|
|
uptime = -1;
|
|
}
|
|
}
|
|
|
|
/* Compute current time. */
|
|
if(sef_debug_boottime==-1 || sef_debug_system_hz==-1 || uptime==-1) {
|
|
sef_debug_time_sec = 0;
|
|
sef_debug_time_us = 0;
|
|
}
|
|
else {
|
|
sef_debug_time_sec = (time_t) (sef_debug_boottime
|
|
+ (uptime/sef_debug_system_hz));
|
|
sef_debug_time_us = (uptime%sef_debug_system_hz)
|
|
* 1000000/sef_debug_system_hz;
|
|
}
|
|
}
|
|
|
|
/*===========================================================================*
|
|
* sef_debug_header *
|
|
*===========================================================================*/
|
|
PUBLIC char* sef_debug_header(void)
|
|
{
|
|
/* Build and return a SEF debug header. */
|
|
sef_debug_refresh_params();
|
|
sprintf(sef_debug_header_buff, "%s: time = %ds %06dus",
|
|
sef_self_name, (int) sef_debug_time_sec, (int) sef_debug_time_us);
|
|
|
|
return sef_debug_header_buff;
|
|
}
|
|
|