/* *---------------------------------------------------------------------- *    T-Kernel * *    Copyright (C) 2004 by Ken Sakamura. All rights reserved. *    T-Kernel is distributed under the T-License. *---------------------------------------------------------------------- * *    Version:   1.01.00 *    Released by T-Engine Forum(http://www.t-engine.org) at 2004/6/28. * *---------------------------------------------------------------------- *//* *	system.c (T-Kernel/SM) *	System Information Management Function *	System Memory Management Function */#include "sysmgr.h"#include "syslog.h"#include <sys/imalloc.h>#include <sys/commarea.h>#include <sys/svc/ifsysmgr.h>#include <sys/sysinfo.h>#define	SYSCONF		( SCInfo.sysconf )#define	DEVCONF		( SCInfo.devconf )/* ------------------------------------------------------------------------ *//* *	System information management function *//* * Search 'name' information *	If it is not found, return NULL. */LOCAL UB* search_conf( UB *cp, UB *name ){	INT	len = strlen(name);	UB	*p;	while ( *cp != '\0' ) {		if ( *cp == name[0] ) {			for ( p = cp; *p > ' ' && *p != '#'; ++p );			if ( p - cp == len && memcmp(cp, name, len) == 0 ) {				return cp; /* Found */			}		}		/* Next */		while ( *cp != '\0' && *cp++ != '\n' );	}	return NULL;}/* * Skip to the next word *	If it is the end, return NULL. */LOCAL UB* skip_next( UB *p ){	UB	c;	/* Skip reading current word */	while ( (c = *p) > ' ' && c != '#' ) ++p;	/* Skip reading word separators */	while ( (c = *p) != '\0' ) {		if ( c == '\n' || c == '#' ) break;		if ( c > ' ' ) return p;		p++;	}	return NULL;}/* * Get numeric value information */LOCAL INT getcfn( UB *conf, UB *name, INT *val, INT max ){	UB	*p;	INT	v, n;	p = search_conf(conf, name);	if ( p == NULL ) return E_NOEXS; /* Not found */	n = 0;	while ( (p = skip_next(p)) != NULL ) {		v = strtol((char*)p, (char**)&p, 0);		if ( max-- > 0 ) *val++ = v;		n++;	}	return n;}/* * Get string information */LOCAL INT getcfs( UB *conf, UB *name, UB *bp, INT max ){	UB	*p, *sp, c;	p = search_conf(conf, name);	if ( p == NULL ) return E_NOEXS; /* Not found */	sp = skip_next(p);	if ( sp == NULL ) return 0; /* Date is not defined */	for ( p = sp; (c = *p) != '\0'; ++p ) {		if ( c == '\n' || c == '#' ) break;		if ( max-- > 0 ) *bp++ = c;	}	if ( max > 0 ) *bp = '\0';	return p - sp;}/* * Get system information (numeric values) *	Call directly from T-Kernel/OS. *	Do not call system call and extension SVC because  *	they are also called during starting system. */EXPORT INT _tk_get_cfn( UB *name, INT *val, INT max ){	INT	n;	n = getcfn(SYSCONF, name, val, max);	if ( n < 0 ) {		n = getcfn(DEVCONF, name, val, max);	}	if ( n < 0 ) goto err_ret;	return n;err_ret:	BMS_DEBUG_PRINT(("_tk_get_cfn err = %d\n", n));	return n;}/* * Get system information (numeric values) */LOCAL INT __tk_get_cfn( UB *name, INT *val, INT max ){	ER	err;	err = ChkSpaceBstrR(name, 0);	if ( err < E_OK ) goto err_ret;	err = ChkSpaceRW(val, sizeof(INT) * max);	if ( err < E_OK ) goto err_ret;	err = _tk_get_cfn(name, val, max);	if ( err < E_OK ) goto err_ret;	return err;err_ret:	DEBUG_PRINT(("__tk_get_cfn err = %d\n", err));	return err;}/* * Get system information (strings) *	Call directly from T-Kernel/OS. *	Do not call system call and extension SVC because  *	they are also called during starting system. */EXPORT INT _tk_get_cfs( UB *name, UB *buf, INT max ){	INT	n;	n = getcfs(SYSCONF, name, buf, max);	if ( n < 0 ) {		n = getcfs(DEVCONF, name, buf, max);	}	if ( n < 0 ) goto err_ret;	return n;err_ret:	BMS_DEBUG_PRINT(("_tk_get_cfs err = %d\n", n));	return n;}/* * Get system information (strings) */LOCAL INT __tk_get_cfs( UB *name, UB *buf, INT max ){	ER	err;	err = ChkSpaceBstrR(name, 0);	if ( err < E_OK ) goto err_ret;	err = ChkSpaceRW(buf, max);	if ( err < E_OK ) goto err_ret;	err = _tk_get_cfs(name, buf, max);	if ( err < E_OK ) goto err_ret;	return err;err_ret:	DEBUG_PRINT(("__tk_get_cfs err = %d\n", err));	return err;}/* ------------------------------------------------------------------------ *//* *	System memory management function * *	Only the extension SVC entry part is processed. Real memory  *	management function is in virtual storage system and real storage *	system respectively. *	In virtual storage system, execute by the upper memory management  *	function. *	Real storage system has the memory management function in  *	T-Kernel/SM. */#define	VALID_MEMATR	(TA_RNG3 | TA_NORESIDENT | TA_NOCACHE)/* * Get system memory */LOCAL ER _tk_get_smb( VP *addr, INT nblk, UINT attr ){	ER	err;	if ( (attr & ~VALID_MEMATR) != 0 ) { err = E_PAR; goto err_ret; }	err = ChkSpaceRW(addr, sizeof(VP));	if ( err < E_OK ) goto err_ret;	*addr = GetSysMemBlk(nblk, attr);	if ( *addr == NULL ) { err = E_NOMEM; goto err_ret; }	return E_OK;err_ret:	DEBUG_PRINT(("_tk_get_smb err = %d\n", err));	return err;}/* * Free system memory */LOCAL ER _tk_rel_smb( VP addr ){	ER	err;	err = RelSysMemBlk(addr);	if ( err < E_OK ) goto err_ret;	return E_OK;err_ret:	DEBUG_PRINT(("_tk_rel_smb err = %d\n", err));	return err;}/* * Get system memory information */LOCAL ER _tk_ref_smb( T_RSMB *pk_rsmb ){	ER	err;	err = ChkSpaceRW(pk_rsmb, sizeof(T_RSMB));	if ( err < E_OK ) goto err_ret;	err = RefSysMemInfo(pk_rsmb);	if ( err < E_OK ) goto err_ret;	return E_OK;err_ret:	DEBUG_PRINT(("_tk_ref_smb err = %d\n", err));	return err;}/* ------------------------------------------------------------------------ *//* *	Kernel shared data */LOCAL	CommArea	_CommArea;	/* Kernel shared data area */IMPORT	CommArea	*__CommArea;	/* libtk *//* * Get Kernel shared data */LOCAL ER __GetKernelCommonArea( CommArea **area ){	*area = &_CommArea;	return E_OK;}/* * Kernel shared data initial setting */LOCAL void initKernelCommonArea( void ){	INT	n, val;	__CommArea = &_CommArea;	n = _tk_get_cfn("TEV_FFLock", &val, 1);	_CommArea.tev_fflock = ( n > 0 )? val: 0;}/* ------------------------------------------------------------------------ *//* * Extension SVC entry  */LOCAL INT sysmgr_svcentry( VP pk_para, FN fncd ){	ER	err;	switch ( fncd ) {		/* Ignore protection level */	  case SYSTEM_TK_GET_CFN_FN:	  case SYSTEM_TK_GET_CFS_FN:	  case SYSTEM__SYSLOG_SEND_FN:		break;	  default:		/* Test call protection level */		err = ChkCallPLevel();		if ( err < E_OK ) goto err_ret;	}	switch ( fncd ) {	  case SYSTEM_TK_GET_CFN_FN:		{ SYSTEM_TK_GET_CFN_PARA *p = pk_para;		return __tk_get_cfn(p->name, p->val, p->max); }	  case SYSTEM_TK_GET_CFS_FN:		{ SYSTEM_TK_GET_CFS_PARA *p = pk_para;		return __tk_get_cfs(p->name, p->buf, p->max); }	  case SYSTEM_TK_GET_SMB_FN:		{ SYSTEM_TK_GET_SMB_PARA *p = pk_para;		return _tk_get_smb(p->addr, p->nblk, p->attr); }	  case SYSTEM_TK_REL_SMB_FN:		{ SYSTEM_TK_REL_SMB_PARA *p = pk_para;		return _tk_rel_smb(p->addr); }	  case SYSTEM_TK_REF_SMB_FN:		{ SYSTEM_TK_REF_SMB_PARA *p = pk_para;		return _tk_ref_smb(p->pk_rsmb); }	  case SYSTEM__GETKERNELCOMMONAREA_FN:		{ SYSTEM__GETKERNELCOMMONAREA_PARA *p = pk_para;		return __GetKernelCommonArea(p->area); }	  case SYSTEM__SYSLOG_SEND_FN:		{ SYSTEM__SYSLOG_SEND_PARA *p = pk_para;		return __syslog_send(p->string, p->len); }	}	err = E_RSFN;err_ret:	DEBUG_PRINT(("sysmgr_svcentry err = %d\n", err));	return err;}/* * Initialization of system management */EXPORT ER initialize_sysmgr( void ){	T_DSSY	dssy;	ER	err;	/* Kernel shared data area setting */	initKernelCommonArea();	/* syslog initialization sequence */	err = initialize_syslog();	if ( err < E_OK ) goto err_ret;	/* subsystem registration */	dssy.ssyatr    = TA_NULL;	dssy.ssypri    = SYSTEM_PRI;	dssy.svchdr    = (FP)&sysmgr_svcentry;	dssy.breakfn   = NULL;	dssy.startupfn = NULL;	dssy.cleanupfn = NULL;	dssy.eventfn   = NULL;	dssy.resblksz  = 0;	err = tk_def_ssy(SYSTEM_SVC, &dssy);	if ( err < E_OK ) goto err_ret;	return E_OK;err_ret:	DEBUG_PRINT(("initialize_sysmgr err = %d\n", err));	return err;}/* * Finalization sequence of system management  */EXPORT ER finish_sysmgr( void ){	ER	err, error = E_OK;	/* Unregister subsystem */	err = tk_def_ssy(SYSTEM_SVC, NULL);	if ( err < E_OK ) error = err;	/* syslog finalization sequence */	err = finish_syslog();	if ( err < E_OK ) error = err;#ifdef DEBUG	if ( error < E_OK ) DEBUG_PRINT(("finish_sysmgr err = %d\n", error));#endif	return error;}