WebSVN – HelenOS – Diff – /trunk/kernel/generic/src/lib/rd.c


/*
 * Copyright (c) 2006 Martin Decky
 * 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.
 */
 
/** @addtogroup genericmm
 * @{
 */
 
/**
 * @file
 * @brief   RAM disk support.
 *
 * Support for RAM disk images.
 */
 
#include <lib/rd.h>
#include <arch/byteorder.h>
#include <mm/frame.h>
#include <sysinfo/sysinfo.h>
#include <ddi/ddi.h>
#include <print.h>
#include <align.h>
 
static parea_t rd_parea;        /**< Physical memory area for rd. */
 
/**
 * RAM disk initialization routine. At this point, the RAM disk memory is shared
 * and information about the share is provided as sysinfo values to the userspace
 * tasks.
 */  
int init_rd(rd_header * header, size_t size)
{
    /* Identify RAM disk */
    if ((header->magic[0] != RD_MAG0) || (header->magic[1] != RD_MAG1) ||
        (header->magic[2] != RD_MAG2) || (header->magic[3] != RD_MAG3))
        return RE_INVALID;
   
    /* Identify version */ 
    if (header->version != RD_VERSION)
        return RE_UNSUPPORTED;
   
    uint32_t hsize;
    uint64_t dsize;
    switch (header->data_type) {
    case RD_DATA_LSB:
        hsize = uint32_t_le2host(header->header_size);
        dsize = uint64_t_le2host(header->data_size);
        break;
    case RD_DATA_MSB:
        hsize = uint32_t_be2host(header->header_size);
        dsize = uint64_t_be2host(header->data_size);
        break;
    default:
        return RE_UNSUPPORTED;
    }
   
    if ((hsize % FRAME_SIZE) || (dsize % FRAME_SIZE))
        return RE_UNSUPPORTED;
   
    if (dsize % FRAME_SIZE)
        return RE_UNSUPPORTED;
 
    if (hsize > size)
        return RE_INVALID;
   
    if ((uint64_t) hsize + dsize > size)
        dsize = size - hsize;
   
    rd_parea.pbase = ALIGN_DOWN((uintptr_t) KA2PA((void *) header + hsize), FRAME_SIZE);
    rd_parea.vbase = (uintptr_t) ((void *) header + hsize);
    rd_parea.frames = SIZE2FRAMES(dsize);
    rd_parea.cacheable = true;
    ddi_parea_register(&rd_parea);
 
    sysinfo_set_item_val("rd", NULL, true);
    sysinfo_set_item_val("rd.header_size", NULL, hsize);   
    sysinfo_set_item_val("rd.size", NULL, dsize);
    sysinfo_set_item_val("rd.address.physical", NULL, (unative_t)
        KA2PA((void *) header + hsize));
 
    return RE_OK;
}
 
/** @}
 */
 

Rev 2141	Rev 2445
1	/*	1	/*
2	* Copyright (c) 2006 Martin Decky	2	* Copyright (c) 2006 Martin Decky
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	/** @addtogroup genericmm	29	/** @addtogroup genericmm
30	* @{	30	* @{
31	*/	31	*/
32		32
33	/**	33	/**
34	* @file	34	* @file
35	* @brief RAM disk support.	35	* @brief RAM disk support.
36	*	36	*
37	* Support for RAM disk images.	37	* Support for RAM disk images.
38	*/	38	*/
39		39
40	#include <lib/rd.h>	40	#include <lib/rd.h>
41	#include <arch/byteorder.h>	41	#include <arch/byteorder.h>
42	#include <mm/frame.h>	42	#include <mm/frame.h>
43	#include <sysinfo/sysinfo.h>	43	#include <sysinfo/sysinfo.h>
44	#include <ddi/ddi.h>	44	#include <ddi/ddi.h>
-		45	#include <print.h>
-		46	#include <align.h>
45		47
46	static parea_t rd_parea; /*< Physical memory area for rd. /	48	static parea_t rd_parea; /*< Physical memory area for rd. /
47		49
-		50	/**
-		51	* RAM disk initialization routine. At this point, the RAM disk memory is shared
-		52	* and information about the share is provided as sysinfo values to the userspace
-		53	* tasks.
-		54	*/
48	int init_rd(rd_header * header, size_t size)	55	int init_rd(rd_header * header, size_t size)
49	{	56	{
50	/* Identify RAM disk */	57	/* Identify RAM disk */
51	if ((header->magic[0] != RD_MAG0) \|\| (header->magic[1] != RD_MAG1) \|\|	58	if ((header->magic[0] != RD_MAG0) \|\| (header->magic[1] != RD_MAG1) \|\|
52	(header->magic[2] != RD_MAG2) \|\| (header->magic[3] != RD_MAG3))	59	(header->magic[2] != RD_MAG2) \|\| (header->magic[3] != RD_MAG3))
53	return RE_INVALID;	60	return RE_INVALID;
54		61
55	/* Identify version */	62	/* Identify version */
56	if (header->version != RD_VERSION)	63	if (header->version != RD_VERSION)
57	return RE_UNSUPPORTED;	64	return RE_UNSUPPORTED;
58		65
59	uint32_t hsize;	66	uint32_t hsize;
60	uint64_t dsize;	67	uint64_t dsize;
61	switch (header->data_type) {	68	switch (header->data_type) {
62	case RD_DATA_LSB:	69	case RD_DATA_LSB:
63	hsize = uint32_t_le2host(header->header_size);	70	hsize = uint32_t_le2host(header->header_size);
64	dsize = uint64_t_le2host(header->data_size);	71	dsize = uint64_t_le2host(header->data_size);
65	break;	72	break;
66	case RD_DATA_MSB:	73	case RD_DATA_MSB:
67	hsize = uint32_t_be2host(header->header_size);	74	hsize = uint32_t_be2host(header->header_size);
68	dsize = uint64_t_be2host(header->data_size);	75	dsize = uint64_t_be2host(header->data_size);
69	break;	76	break;
70	default:	77	default:
71	return RE_UNSUPPORTED;	78	return RE_UNSUPPORTED;
72	}	79	}
73		80
74	if ((hsize % FRAME_SIZE) \|\| (dsize % FRAME_SIZE))	81	if ((hsize % FRAME_SIZE) \|\| (dsize % FRAME_SIZE))
75	return RE_UNSUPPORTED;	82	return RE_UNSUPPORTED;
76		83
-		84	if (dsize % FRAME_SIZE)
-		85	return RE_UNSUPPORTED;
-		86
77	if (hsize > size)	87	if (hsize > size)
78	return RE_INVALID;	88	return RE_INVALID;
79		89
80	if ((uint64_t) hsize + dsize > size)	90	if ((uint64_t) hsize + dsize > size)
81	dsize = size - hsize;	91	dsize = size - hsize;
82		92
83	rd_parea.pbase = KA2PA((void *) header + hsize);	93	rd_parea.pbase = ALIGN_DOWN((uintptr_t) KA2PA((void *) header + hsize), FRAME_SIZE);
84	rd_parea.vbase = (uintptr_t) ((void *) header + hsize);	94	rd_parea.vbase = (uintptr_t) ((void *) header + hsize);
85	rd_parea.frames = SIZE2FRAMES(dsize);	95	rd_parea.frames = SIZE2FRAMES(dsize);
86	rd_parea.cacheable = true;	96	rd_parea.cacheable = true;
87	ddi_parea_register(&rd_parea);	97	ddi_parea_register(&rd_parea);
88		98
89	sysinfo_set_item_val("rd", NULL, true);	99	sysinfo_set_item_val("rd", NULL, true);
-		100	sysinfo_set_item_val("rd.header_size", NULL, hsize);
90	sysinfo_set_item_val("rd.size", NULL, dsize);	101	sysinfo_set_item_val("rd.size", NULL, dsize);
91	sysinfo_set_item_val("rd.address.physical", NULL, (unative_t)	102	sysinfo_set_item_val("rd.address.physical", NULL, (unative_t)
92	KA2PA((void *) header + hsize));	103	KA2PA((void *) header + hsize));
93		104
94	return RE_OK;	105	return RE_OK;
95	}	106	}
96		107
97	/** @}	108	/** @}
98	*/	109	*/
99		110

Subversion Repositories HelenOS

(root)/trunk/kernel/generic/src/lib/rd.c – Rev 2141 → 2445