gdevcnf.c

来自「日本很有名的一个嵌入式RTOS」· C语言 代码 · 共 95 行

/*
 *----------------------------------------------------------------------
 *    T-Kernel
 *
 *    Copyright (C) 2004-2006 by Ken Sakamura. All rights reserved.
 *    T-Kernel is distributed under the T-License.
 *----------------------------------------------------------------------
 *
 *    Version:   1.02.01
 *    Released by T-Engine Forum(http://www.t-engine.org) at 2006/1/10.
 *
 *----------------------------------------------------------------------
 */

/*
 *      gdevcnf.c (sysinit)
 *      DEVCONF access utilities
 */

#include "sysinit.h"
#include <device/devconf.h>
#include <sys/sysinfo.h>
#include <libstr.h>
#define DevConfPtr	(SCInfo.devconf)

LOCAL	UB	*SearchDevConf(UB *name)
{
	W	len;
	UB	*p;

	len = (W)strlen((char*)name);
	if (len > 0) {
		if (len > 16) {
			len = 16;
		}
		for (p = DevConfPtr; *p; ) {
			if (*p > ' ' && *p != '#' && memcmp(name, p, (size_t)len) == 0) {
				return p;
			}
			while (*p && *p++ != '\n') {
				;
			}
		}
	}
	return	(UB*)NULL;
}

LOCAL	UB	*SkipNext(UB *p)
{
	for (; *p > ' ' && *p != '#'; p++) {
		;
	}
	for ( ; ; p++) {
		if (*p == '\0' || *p == '\n' || *p == '#') {
			return (UB*)NULL;
		}
		if (*p > ' ') {
			break;
		}
	}
	return p;
}

EXPORT	W	GetDevConf(UB *name, W *val)
{
	W	cnt = 0;
	UB	*p;

	if ( (p = SearchDevConf(name)) != NULL ) {
		for ( ; (p = SkipNext(p)) && cnt < L_DEVCONF_VAL; cnt++) {
			*val++ = (W)strtol((char*)p, (char**)&p, 0);
		}
	}
	return cnt;
}

EXPORT	W	GetDevConfStr(UB *name, UB *str)
{
	UB	*p;
	UB	*d = str;

	if ( (p = SearchDevConf(name)) != NULL ) {
		if ( (p = SkipNext(p)) != NULL ) {
			while (*p && *p != '\n' && *p != '#') {
				*d++ = *p++;
				if (d - str >= L_DEVCONF_STR - 1) {
					break;
				}
			}
		}
	}
	*d = 0;
	return d - str;
}