WebSVN – HelenOS – Diff – /branches/dd/kernel/generic/src/lib/func.c


/*
 * Copyright (C) 2001-2004 Jakub Jermar
 * All rights reserved.
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions
 * are met:
 *
 * - Redistributions of source code must retain the above copyright
 *   notice, this list of conditions and the following disclaimer.
 * - Redistributions in binary form must reproduce the above copyright
 *   notice, this list of conditions and the following disclaimer in the
 *   documentation and/or other materials provided with the distribution.
 * - The name of the author may not be used to endorse or promote products
 *   derived from this software without specific prior written permission.
 *
 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
 */
 
#include <func.h>
#include <print.h>
#include <cpu.h>
#include <arch/asm.h>
#include <arch.h>
#include <typedefs.h>
 
__u32   haltstate = 0; /**< Halt flag */
 
 
/** Halt wrapper
 *
 * Set halt flag and halt the cpu.
 *
 */
void halt(void)
{
    haltstate = 1;
    interrupts_disable();
    if (CPU)
        printf("cpu%d: halted\n", CPU->id);
    else
        printf("cpu: halted\n");
    cpu_halt();
}
 
/** Return number of characters in a string.
 *
 * @param str NULL terminated string.
 *
 * @return Number of characters in str.
 */
size_t strlen(const char *str)
{
    int i;
   
    for (i = 0; str[i]; i++)
        ;
   
    return i;
}
 
/** Compare two NULL terminated strings
 *
 * Do a char-by-char comparison of two NULL terminated strings.
 * The strings are considered equal iff they consist of the same
 * characters on the minimum of their lengths and specified maximal
 * length.
 *
 * @param src First string to compare.
 * @param dst Second string to compare.
 * @param len Maximal length for comparison.
 *
 * @return 0 if the strings are equal, 1 otherwise.
 *
 */
int strncmp(const char *src, const char *dst, size_t len)
{
    int i;
   
    i = 0;
    while ((i < len) && (src[i] == dst[i])) {
        if ((i == len - 1) || (src[i] == '\0'))
            return 0;
        i++;
    }
    return 1;
}
 
/** Copy NULL terminated string.
 *
 * Copy at most 'len' characters from string 'src' to 'dest'.
 * If 'src' is shorter than 'len', '\0' is inserted behind the
 * last copied character.
 *
 * @param src Source string.
 * @param dst Destination buffer.
 * @param len Size of destination buffer.
 */
void strncpy(char *dest, const char *src, size_t len)
{
    int i;
    for (i = 0; i < len; i++) {
        if (!(dest[i] = src[i]))
            return;
    }
}
 

Subversion Repositories HelenOS

(root)/branches/dd/kernel/generic/src/lib/func.c @ 4055 – Rev 518 → 532

Rev 518		Rev 532
1	/*	1	/*
2	* Copyright (C) 2001-2004 Jakub Jermar	2	* Copyright (C) 2001-2004 Jakub Jermar
3	* All rights reserved.	3	* All rights reserved.
4	*	4	*
5	* Redistribution and use in source and binary forms, with or without	5	* Redistribution and use in source and binary forms, with or without
6	* modification, are permitted provided that the following conditions	6	* modification, are permitted provided that the following conditions
7	* are met:	7	* are met:
8	*	8	*
9	* - Redistributions of source code must retain the above copyright	9	* - Redistributions of source code must retain the above copyright
10	* notice, this list of conditions and the following disclaimer.	10	* notice, this list of conditions and the following disclaimer.
11	* - Redistributions in binary form must reproduce the above copyright	11	* - Redistributions in binary form must reproduce the above copyright
12	* notice, this list of conditions and the following disclaimer in the	12	* notice, this list of conditions and the following disclaimer in the
13	* documentation and/or other materials provided with the distribution.	13	* documentation and/or other materials provided with the distribution.
14	* - The name of the author may not be used to endorse or promote products	14	* - The name of the author may not be used to endorse or promote products
15	* derived from this software without specific prior written permission.	15	* derived from this software without specific prior written permission.
16	*	16	*
17	* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR	17	* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
18	* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES	18	* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
19	* OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.	19	* OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
20	* IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,	20	* IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
21	* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT	21	* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
22	* NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,	22	* NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
23	* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY	23	* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
24	* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT	24	* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
25	* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF	25	* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
26	* THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.	26	* THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
27	*/	27	*/
28		28
29	#include <func.h>	29	#include <func.h>
30	#include <print.h>	30	#include <print.h>
31	#include <cpu.h>	31	#include <cpu.h>
32	#include <arch/asm.h>	32	#include <arch/asm.h>
33	#include <arch.h>	33	#include <arch.h>
34	#include <typedefs.h>	34	#include <typedefs.h>
35		35
36	__u32 haltstate = 0; /*< Halt flag /	36	__u32 haltstate = 0; /*< Halt flag /
37		37
38		38
39	/** Halt wrapper	39	/** Halt wrapper
40	*	40	*
41	* Set halt flag and halt the cpu.	41	* Set halt flag and halt the cpu.
42	*	42	*
43	*/	43	*/
44	void halt(void)	44	void halt(void)
45	{	45	{
46	haltstate = 1;	46	haltstate = 1;
47	interrupts_disable();	47	interrupts_disable();
48	if (CPU)	48	if (CPU)
49	printf("cpu%d: halted\n", CPU->id);	49	printf("cpu%d: halted\n", CPU->id);
50	else	50	else
51	printf("cpu: halted\n");	51	printf("cpu: halted\n");
52	cpu_halt();	52	cpu_halt();
53	}	53	}
54		54
55	/** Return number of characters in a string.	55	/** Return number of characters in a string.
56	*	56	*
57	* @param str NULL terminated string.	57	* @param str NULL terminated string.
58	*	58	*
59	* @return Number of characters in str.	59	* @return Number of characters in str.
60	*/	60	*/
61	size_t strlen(const char *str)	61	size_t strlen(const char *str)
62	{	62	{
63	int i;	63	int i;
64		64
65	for (i = 0; str[i]; i++)	65	for (i = 0; str[i]; i++)
66	;	66	;
67		67
68	return i;	68	return i;
69	}	69	}
70		70
71	/** Compare two NULL terminated strings	71	/** Compare two NULL terminated strings
72	*	72	*
73	* Do a char-by-char comparison of two NULL terminated strings.	73	* Do a char-by-char comparison of two NULL terminated strings.
74	* The strings are considered equal iff they consist of the same	74	* The strings are considered equal iff they consist of the same
75	* characters on the minimum of their lengths and specified maximal	75	* characters on the minimum of their lengths and specified maximal
76	* length.	76	* length.
77	*	77	*
78	* @param src First string to compare.	78	* @param src First string to compare.
79	* @param dst Second string to compare.	79	* @param dst Second string to compare.
80	* @param len Maximal length for comparison.	80	* @param len Maximal length for comparison.
81	*	81	*
82	* @return 0 if the strings are equal, 1 otherwise.	82	* @return 0 if the strings are equal, 1 otherwise.
83	*	83	*
84	*/	84	*/
85	int strncmp(const char src, const char dst, size_t len)	85	int strncmp(const char src, const char dst, size_t len)
86	{	86	{
87	int i;	87	int i;
88		88
89	i = 0;	89	i = 0;
90	while ((i < len) && (src[i] == dst[i])) {	90	while ((i < len) && (src[i] == dst[i])) {
91	if ((i == len - 1) \|\| (src[i] == '\0'))	91	if ((i == len - 1) \|\| (src[i] == '\0'))
92	return 0;	92	return 0;
93	i++;	93	i++;
94	}	94	}
95	return 1;	95	return 1;
96	}	96	}
97		97
98	/** Copy NULL terminated string.	98	/** Copy NULL terminated string.
99	*	99	*
100	* Copy at most 'len' characters from string 'src' to 'dest'.	100	* Copy at most 'len' characters from string 'src' to 'dest'.
101	* If 'src' is shorter than 'len', '\0' is inserted behind the	101	* If 'src' is shorter than 'len', '\0' is inserted behind the
102	* last copied character.	102	* last copied character.
103	*	103	*
104	* @param src Source string.	104	* @param src Source string.
105	* @param dst Destination buffer.	105	* @param dst Destination buffer.
106	* @param len Size of destination buffer.	106	* @param len Size of destination buffer.
107	*/	107	*/
108	void strncpy(char dest, const char src, size_t len)	108	void strncpy(char dest, const char src, size_t len)
109	{	109	{
110	int i;	110	int i;
111	for (i = 0; i < len; i++) {	111	for (i = 0; i < len; i++) {
112	if (!(dest[i] = src[i]))	112	if (!(dest[i] = src[i]))
113	return;	113	return;
114	}	114	}
115	}	115	}
116		116