321 lines
9.5 KiB
C
321 lines
9.5 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
|
||
|
char sef_self_name[SEF_SELF_NAME_MAXLEN];
|
||
|
endpoint_t sef_self_endpoint = NONE;
|
||
|
int sef_self_priv_flags;
|
||
|
int sef_self_first_receive_done;
|
||
|
int sef_self_receiving;
|
||
|
|
||
|
/* Debug. */
|
||
|
#if SEF_INIT_DEBUG || SEF_LU_DEBUG || SEF_PING_DEBUG || SEF_SIGNAL_DEBUG
|
||
|
#define SEF_DEBUG_HEADER_MAXLEN 32
|
||
|
static time_t sef_debug_boottime = 0;
|
||
|
static u32_t sef_debug_system_hz = 0;
|
||
|
static time_t sef_debug_time_sec = 0;
|
||
|
static time_t sef_debug_time_us = 0;
|
||
|
static char sef_debug_header_buff[SEF_DEBUG_HEADER_MAXLEN];
|
||
|
static void sef_debug_refresh_params(void);
|
||
|
char* sef_debug_header(void);
|
||
|
#endif
|
||
|
|
||
|
/* SEF Init prototypes. */
|
||
|
EXTERN int do_sef_rs_init(endpoint_t old_endpoint);
|
||
|
EXTERN int do_sef_init_request(message *m_ptr);
|
||
|
|
||
|
/* SEF Ping prototypes. */
|
||
|
EXTERN int do_sef_ping_request(message *m_ptr);
|
||
|
|
||
|
/* SEF Live update prototypes. */
|
||
|
EXTERN void do_sef_lu_before_receive(void);
|
||
|
EXTERN int do_sef_lu_request(message *m_ptr);
|
||
|
|
||
|
/* SEF Signal prototypes. */
|
||
|
EXTERN int do_sef_signal_request(message *m_ptr);
|
||
|
|
||
|
/* SEF GCOV prototypes. */
|
||
|
#ifdef USE_COVERAGE
|
||
|
EXTERN int do_sef_gcov_request(message *m_ptr);
|
||
|
#endif
|
||
|
|
||
|
/* SEF Fault Injection prototypes. */
|
||
|
EXTERN int do_sef_fi_request(message *m_ptr);
|
||
|
|
||
|
/*===========================================================================*
|
||
|
* sef_startup *
|
||
|
*===========================================================================*/
|
||
|
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;
|
||
|
strlcpy(sef_self_name, "Unknown", sizeof(sef_self_name));
|
||
|
}
|
||
|
sef_self_priv_flags = priv_flags;
|
||
|
old_endpoint = NONE;
|
||
|
|
||
|
#if USE_LIVEUPDATE
|
||
|
/* 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: %d",
|
||
|
RS_PROC_NR, sef_self_endpoint, r);
|
||
|
}
|
||
|
old_endpoint = sef_self_endpoint;
|
||
|
sef_self_endpoint = RS_PROC_NR;
|
||
|
}
|
||
|
#endif /* USE_LIVEUPDATE */
|
||
|
|
||
|
#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", r);
|
||
|
}
|
||
|
}
|
||
|
else if(sef_self_endpoint == VM_PROC_NR) {
|
||
|
/* VM handles initialization by RS later */
|
||
|
} 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 = ipc_receive(RS_PROC_NR, &m, &status);
|
||
|
if(r != OK) {
|
||
|
panic("unable to ipc_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 *
|
||
|
*===========================================================================*/
|
||
|
int sef_receive_status(endpoint_t src, message *m_ptr, int *status_ptr)
|
||
|
{
|
||
|
/* SEF receive() interface for system services. */
|
||
|
int r, status;
|
||
|
|
||
|
sef_self_receiving = TRUE;
|
||
|
|
||
|
while(TRUE) {
|
||
|
/* If the caller indicated that it no longer wants to receive a message,
|
||
|
* return now.
|
||
|
*/
|
||
|
if (!sef_self_receiving)
|
||
|
return EINTR;
|
||
|
|
||
|
#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 = ipc_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
|
||
|
|
||
|
#ifdef INTERCEPT_SEF_FI_REQUESTS
|
||
|
/* Intercept Fault injection requests. */
|
||
|
if(IS_SEF_FI_REQUEST(m_ptr, status)) {
|
||
|
if(do_sef_fi_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_self *
|
||
|
*===========================================================================*/
|
||
|
endpoint_t sef_self(void)
|
||
|
{
|
||
|
/* Return the process's own endpoint number. */
|
||
|
|
||
|
if (sef_self_endpoint == NONE)
|
||
|
panic("sef_self called before initialization");
|
||
|
|
||
|
return sef_self_endpoint;
|
||
|
}
|
||
|
|
||
|
/*===========================================================================*
|
||
|
* sef_cancel *
|
||
|
*===========================================================================*/
|
||
|
void sef_cancel(void)
|
||
|
{
|
||
|
/* Cancel receiving a message. This function be called from a callback invoked
|
||
|
* from within sef_receive_status(), which will then return an EINTR error
|
||
|
* code. In particular, this function can be used to exit from the main receive
|
||
|
* loop when a signal handler causes the process to want to shut down.
|
||
|
*/
|
||
|
|
||
|
sef_self_receiving = FALSE;
|
||
|
}
|
||
|
|
||
|
/*===========================================================================*
|
||
|
* sef_exit *
|
||
|
*===========================================================================*/
|
||
|
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 everything else fails, hang. */
|
||
|
printf("Warning: system service %d couldn't exit\n", sef_self_endpoint);
|
||
|
for(;;) { }
|
||
|
}
|
||
|
|
||
|
#ifdef __weak_alias
|
||
|
__weak_alias(_exit, sef_exit);
|
||
|
__weak_alias(__exit, sef_exit);
|
||
|
#endif
|
||
|
|
||
|
#if SEF_INIT_DEBUG || SEF_LU_DEBUG || SEF_PING_DEBUG || SEF_SIGNAL_DEBUG
|
||
|
/*===========================================================================*
|
||
|
* sef_debug_refresh_params *
|
||
|
*===========================================================================*/
|
||
|
static 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 *
|
||
|
*===========================================================================*/
|
||
|
char* sef_debug_header(void)
|
||
|
{
|
||
|
/* Build and return a SEF debug header. */
|
||
|
sef_debug_refresh_params();
|
||
|
snprintf(sef_debug_header_buff, sizeof(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;
|
||
|
}
|
||
|
#endif /*SEF_INIT_DEBUG || SEF_LU_DEBUG || SEF_PING_DEBUG || SEF_SIGNAL_DEBUG*/
|
||
|
|