281 lines
8.6 KiB
C
281 lines
8.6 KiB
C
#include "syslib.h"
|
|
#include <assert.h>
|
|
#include <minix/sysutil.h>
|
|
#include <stdio.h>
|
|
#include <stdlib.h>
|
|
#include <unistd.h>
|
|
#include <string.h>
|
|
|
|
/* Self variables. */
|
|
#define SEF_SELF_NAME_MAXLEN 20
|
|
PUBLIC char sef_self_name[SEF_SELF_NAME_MAXLEN];
|
|
PUBLIC endpoint_t sef_self_endpoint;
|
|
PUBLIC int sef_self_priv_flags;
|
|
PUBLIC int sef_self_first_receive_done;
|
|
|
|
/* 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. */
|
|
#ifdef USE_COVERAGE
|
|
EXTERN _PROTOTYPE( int do_sef_gcov_request, (message *m_ptr) );
|
|
#endif
|
|
EXTERN _PROTOTYPE( int do_sef_rs_init, (endpoint_t old_endpoint) );
|
|
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;
|
|
endpoint_t old_endpoint;
|
|
int priv_flags;
|
|
|
|
/* Get information about self. */
|
|
r = sys_whoami(&sef_self_endpoint, sef_self_name, SEF_SELF_NAME_MAXLEN,
|
|
&priv_flags);
|
|
if ( r != OK) {
|
|
sef_self_endpoint = SELF;
|
|
sprintf(sef_self_name, "%s", "Unknown");
|
|
}
|
|
sef_self_priv_flags = priv_flags;
|
|
old_endpoint = NONE;
|
|
|
|
/* RS may wake up with the wrong endpoint, perfom the update in that case. */
|
|
if((sef_self_priv_flags & ROOT_SYS_PROC) && sef_self_endpoint != RS_PROC_NR) {
|
|
r = vm_update(RS_PROC_NR, sef_self_endpoint);
|
|
if(r != OK) {
|
|
panic("unable to update RS from instance %d to %d",
|
|
RS_PROC_NR, sef_self_endpoint);
|
|
}
|
|
old_endpoint = sef_self_endpoint;
|
|
sef_self_endpoint = RS_PROC_NR;
|
|
}
|
|
|
|
#if INTERCEPT_SEF_INIT_REQUESTS
|
|
/* Intercept SEF Init requests. */
|
|
if(sef_self_priv_flags & ROOT_SYS_PROC) {
|
|
/* RS initialization is special. */
|
|
if((r = do_sef_rs_init(old_endpoint)) != OK) {
|
|
panic("RS unable to complete init: %d (%s)", r, strerror(-r));
|
|
}
|
|
}
|
|
else {
|
|
message m;
|
|
|
|
/* Wait for an initialization message from RS. We need this to learn the
|
|
* initialization type and parameters. When restarting after a crash, we
|
|
* may get some spurious IPC messages from RS (e.g. update request) that
|
|
* were originally meant to be delivered to the old instance. We discard
|
|
* these messages and block till a proper initialization request arrives.
|
|
*/
|
|
do {
|
|
r = receive(RS_PROC_NR, &m, &status);
|
|
if(r != OK) {
|
|
panic("unable to receive from RS: %d", r);
|
|
}
|
|
} while(!IS_SEF_INIT_REQUEST(&m));
|
|
|
|
/* Process initialization request for this system service. */
|
|
if((r = do_sef_init_request(&m)) != OK) {
|
|
panic("unable to process init request: %d", r);
|
|
}
|
|
}
|
|
#endif
|
|
|
|
/* (Re)initialize SEF variables. */
|
|
sef_self_first_receive_done = FALSE;
|
|
sef_self_priv_flags = priv_flags;
|
|
}
|
|
|
|
/*===========================================================================*
|
|
* 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(!sef_self_first_receive_done) sef_self_first_receive_done = TRUE;
|
|
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
|
|
|
|
#ifdef USE_COVERAGE
|
|
/* Intercept GCOV data requests (sent by VFS in vfs/gcov.c). */
|
|
if(m_ptr->m_type == COMMON_REQ_GCOV_DATA &&
|
|
m_ptr->m_source == VFS_PROC_NR) {
|
|
if(do_sef_gcov_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);
|
|
panic("sef_exit failed");
|
|
}
|
|
|
|
/*===========================================================================*
|
|
* __exit *
|
|
*===========================================================================*/
|
|
PUBLIC void __exit(int status)
|
|
{
|
|
/* Make exit() an alias for sef_exit() for system services. */
|
|
sef_exit(status);
|
|
panic("sef_exit failed");
|
|
}
|
|
|
|
/*===========================================================================*
|
|
* 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;
|
|
}
|
|
|