WebSVN – HelenOS – Diff – /branches/dynload/uspace/srv/bd/gxe_bd/gxe_bd.c


/*
 * Copyright (c) 2009 Jiri Svoboda
 * 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 bd
 * @{
 */
 
/**
 * @file
 * @brief GXemul disk driver
 */
 
#include <stdio.h>
#include <libarch/ddi.h>
#include <ddi.h>
#include <ipc/ipc.h>
#include <ipc/bd.h>
#include <async.h>
#include <as.h>
#include <fibril_sync.h>
#include <devmap.h>
#include <sys/types.h>
#include <errno.h>
#include <task.h>
 
#define NAME "gxe_bd"
 
enum {
    CTL_READ_START  = 0,
    CTL_WRITE_START = 1,
};
 
enum {
    STATUS_FAILURE  = 0
};
 
enum {
    MAX_DISKS   = 2
};
 
typedef struct {
    uint32_t offset_lo;
    uint32_t pad0;
    uint32_t offset_hi;
    uint32_t pad1;
 
    uint32_t disk_id;
    uint32_t pad2[3];
 
    uint32_t control;
    uint32_t pad3[3];
 
    uint32_t status;
 
    uint32_t pad4[3];
    uint8_t pad5[0x3fc0];
 
    uint8_t buffer[512];
} gxe_bd_t;
 
 
static const size_t block_size = 512;
static size_t comm_size;
 
static uintptr_t dev_physical = 0x13000000;
static gxe_bd_t *dev;
 
static dev_handle_t dev_handle[MAX_DISKS];
 
static fibril_mutex_t dev_lock[MAX_DISKS];
 
static int gxe_bd_init(void);
static void gxe_bd_connection(ipc_callid_t iid, ipc_call_t *icall);
static int gx_bd_rdwr(int disk_id, ipcarg_t method, off_t offset, size_t size,
    void *buf);
static int gxe_bd_read_block(int disk_id, uint64_t offset, size_t size,
    void *buf);
static int gxe_bd_write_block(int disk_id, uint64_t offset, size_t size,
    const void *buf);
 
int main(int argc, char **argv)
{
    printf(NAME ": GXemul disk driver\n");
 
    if (gxe_bd_init() != EOK)
        return -1;
 
    printf(NAME ": Accepting connections\n");
    task_retval(0);
    async_manager();
 
    /* Not reached */
    return 0;
}
 
static int gxe_bd_init(void)
{
    void *vaddr;
    int rc, i;
    char name[16];
 
    rc = devmap_driver_register(NAME, gxe_bd_connection);
    if (rc < 0) {
        printf(NAME ": Unable to register driver.\n");
        return rc;
    }
 
    rc = pio_enable((void *) dev_physical, sizeof(gxe_bd_t), &vaddr);
    if (rc != EOK) {
        printf(NAME ": Could not initialize device I/O space.\n");
        return rc;
    }
 
    dev = vaddr;
 
    for (i = 0; i < MAX_DISKS; i++) {
        snprintf(name, 16, "disk%d", i);
        rc = devmap_device_register(name, &dev_handle[i]);
        if (rc != EOK) {
            devmap_hangup_phone(DEVMAP_DRIVER);
            printf(NAME ": Unable to register device %s.\n",
                name);
            return rc;
        }
        fibril_mutex_initialize(&dev_lock[i]);
    }
 
    return EOK;
}
 
static void gxe_bd_connection(ipc_callid_t iid, ipc_call_t *icall)
{
    void *fs_va = NULL;
    ipc_callid_t callid;
    ipc_call_t call;
    ipcarg_t method;
    dev_handle_t dh;
    int flags;
    int retval;
    off_t idx;
    size_t size;
    int disk_id, i;
 
    /* Get the device handle. */
    dh = IPC_GET_ARG1(*icall);
 
    /* Determine which disk device is the client connecting to. */
    disk_id = -1;
    for (i = 0; i < MAX_DISKS; i++)
        if (dev_handle[i] == dh)
            disk_id = i;
 
    if (disk_id < 0) {
        ipc_answer_0(iid, EINVAL);
        return;
    }
 
    /* Answer the IPC_M_CONNECT_ME_TO call. */
    ipc_answer_0(iid, EOK);
 
    if (!ipc_share_out_receive(&callid, &comm_size, &flags)) {
        ipc_answer_0(callid, EHANGUP);
        return;
    }
 
    fs_va = as_get_mappable_page(comm_size);
    if (fs_va == NULL) {
        ipc_answer_0(callid, EHANGUP);
        return;
    }
 
    (void) ipc_share_out_finalize(callid, fs_va);
 
    while (1) {
        callid = async_get_call(&call);
        method = IPC_GET_METHOD(call);
        switch (method) {
        case IPC_M_PHONE_HUNGUP:
            /* The other side has hung up. */
            ipc_answer_0(callid, EOK);
            return;
        case BD_READ_BLOCK:
        case BD_WRITE_BLOCK:
            idx = IPC_GET_ARG1(call);
            size = IPC_GET_ARG2(call);
            if (size > comm_size) {
                retval = EINVAL;
                break;
            }
            retval = gx_bd_rdwr(disk_id, method, idx * size,
                size, fs_va);
            break;
        default:
            retval = EINVAL;
            break;
        }
        ipc_answer_0(callid, retval);
    }
}
 
static int gx_bd_rdwr(int disk_id, ipcarg_t method, off_t offset, size_t size,
    void *buf)
{
    int rc;
    size_t now;
 
    while (size > 0) {
        now = size < block_size ? size : block_size;
 
        if (method == BD_READ_BLOCK)
            rc = gxe_bd_read_block(disk_id, offset, now, buf);
        else
            rc = gxe_bd_write_block(disk_id, offset, now, buf);
 
        if (rc != EOK)
            return rc;
 
        buf += block_size;
        offset += block_size;
 
        if (size > block_size)
            size -= block_size;
        else
            size = 0;
    }
 
    return EOK;
}
 
static int gxe_bd_read_block(int disk_id, uint64_t offset, size_t size,
    void *buf)
{
    uint32_t status;
    size_t i;
    uint32_t w;
 
    fibril_mutex_lock(&dev_lock[disk_id]);
    pio_write_32(&dev->offset_lo, (uint32_t) offset);
    pio_write_32(&dev->offset_hi, offset >> 32);
    pio_write_32(&dev->disk_id, disk_id);
    pio_write_32(&dev->control, CTL_READ_START);
 
    status = pio_read_32(&dev->status);
    if (status == STATUS_FAILURE) {
        fibril_mutex_unlock(&dev_lock[disk_id]);
        return EIO;
    }
 
    for (i = 0; i < size; i++) {
        ((uint8_t *) buf)[i] = w = pio_read_8(&dev->buffer[i]);
    }
 
    fibril_mutex_unlock(&dev_lock[disk_id]);
    return EOK;
}
 
static int gxe_bd_write_block(int disk_id, uint64_t offset, size_t size,
    const void *buf)
{
    uint32_t status;
    size_t i;
 
    for (i = 0; i < size; i++) {
        pio_write_8(&dev->buffer[i], ((const uint8_t *) buf)[i]);
    }
 
    fibril_mutex_lock(&dev_lock[disk_id]);
    pio_write_32(&dev->offset_lo, (uint32_t) offset);
    pio_write_32(&dev->offset_hi, offset >> 32);
    pio_write_32(&dev->disk_id, disk_id);
    pio_write_32(&dev->control, CTL_WRITE_START);
 
    status = pio_read_32(&dev->status);
    if (status == STATUS_FAILURE) {
        fibril_mutex_unlock(&dev_lock[disk_id]);
        return EIO;
    }
 
    fibril_mutex_unlock(&dev_lock[disk_id]);
    return EOK;
}
 
/**
 * @}
 */
 

Rev 4621	Rev 4691
1	/*	1	/*
2	* Copyright (c) 2009 Jiri Svoboda	2	* Copyright (c) 2009 Jiri Svoboda
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 bd	29	/** @addtogroup bd
30	* @{	30	* @{
31	*/	31	*/
32		32
33	/**	33	/**
34	* @file	34	* @file
35	* @brief GXemul disk driver	35	* @brief GXemul disk driver
36	*/	36	*/
37		37
38	#include <stdio.h>	38	#include <stdio.h>
39	#include <libarch/ddi.h>	39	#include <libarch/ddi.h>
40	#include <ddi.h>	40	#include <ddi.h>
41	#include <ipc/ipc.h>	41	#include <ipc/ipc.h>
42	#include <ipc/bd.h>	42	#include <ipc/bd.h>
43	#include <async.h>	43	#include <async.h>
44	#include <as.h>	44	#include <as.h>
45	#include <fibril_sync.h>	45	#include <fibril_sync.h>
46	#include <devmap.h>	46	#include <devmap.h>
47	#include <sys/types.h>	47	#include <sys/types.h>
48	#include <errno.h>	48	#include <errno.h>
49	#include <task.h>	49	#include <task.h>
50		50
51	#define NAME "gxe_bd"	51	#define NAME "gxe_bd"
52		52
53	enum {	53	enum {
54	CTL_READ_START = 0,	54	CTL_READ_START = 0,
55	CTL_WRITE_START = 1,	55	CTL_WRITE_START = 1,
56	};	56	};
57		57
58	enum {	58	enum {
59	STATUS_FAILURE = 0	59	STATUS_FAILURE = 0
60	};	60	};
61		61
62	enum {	62	enum {
63	MAX_DISKS = 2	63	MAX_DISKS = 2
64	};	64	};
65		65
66	typedef struct {	66	typedef struct {
67	uint32_t offset_lo;	67	uint32_t offset_lo;
68	uint32_t pad0;	68	uint32_t pad0;
69	uint32_t offset_hi;	69	uint32_t offset_hi;
70	uint32_t pad1;	70	uint32_t pad1;
71		71
72	uint32_t disk_id;	72	uint32_t disk_id;
73	uint32_t pad2[3];	73	uint32_t pad2[3];
74		74
75	uint32_t control;	75	uint32_t control;
76	uint32_t pad3[3];	76	uint32_t pad3[3];
77		77
78	uint32_t status;	78	uint32_t status;
79		79
80	uint32_t pad4[3];	80	uint32_t pad4[3];
81	uint8_t pad5[0x3fc0];	81	uint8_t pad5[0x3fc0];
82		82
83	uint8_t buffer[512];	83	uint8_t buffer[512];
84	} gxe_bd_t;	84	} gxe_bd_t;
85		85
86		86
87	static const size_t block_size = 512;	87	static const size_t block_size = 512;
88	static size_t comm_size;	88	static size_t comm_size;
89		89
90	static uintptr_t dev_physical = 0x13000000;	90	static uintptr_t dev_physical = 0x13000000;
91	static gxe_bd_t *dev;	91	static gxe_bd_t *dev;
92		92
93	static dev_handle_t dev_handle[MAX_DISKS];	93	static dev_handle_t dev_handle[MAX_DISKS];
94		94
95	static fibril_mutex_t dev_lock[MAX_DISKS];	95	static fibril_mutex_t dev_lock[MAX_DISKS];
96		96
97	static int gxe_bd_init(void);	97	static int gxe_bd_init(void);
98	static void gxe_bd_connection(ipc_callid_t iid, ipc_call_t *icall);	98	static void gxe_bd_connection(ipc_callid_t iid, ipc_call_t *icall);
99	static int gx_bd_rdwr(int disk_id, ipcarg_t method, off_t offset, size_t size,	99	static int gx_bd_rdwr(int disk_id, ipcarg_t method, off_t offset, size_t size,
100	void *buf);	100	void *buf);
101	static int gxe_bd_read_block(int disk_id, uint64_t offset, size_t size,	101	static int gxe_bd_read_block(int disk_id, uint64_t offset, size_t size,
102	void *buf);	102	void *buf);
103	static int gxe_bd_write_block(int disk_id, uint64_t offset, size_t size,	103	static int gxe_bd_write_block(int disk_id, uint64_t offset, size_t size,
104	const void *buf);	104	const void *buf);
105		105
106	int main(int argc, char **argv)	106	int main(int argc, char **argv)
107	{	107	{
108	printf(NAME ": GXemul disk driver\n");	108	printf(NAME ": GXemul disk driver\n");
109		109
110	if (gxe_bd_init() != EOK)	110	if (gxe_bd_init() != EOK)
111	return -1;	111	return -1;
112		112
113	printf(NAME ": Accepting connections\n");	113	printf(NAME ": Accepting connections\n");
114	task_retval(0);	114	task_retval(0);
115	async_manager();	115	async_manager();
116		116
117	/* Not reached */	117	/* Not reached */
118	return 0;	118	return 0;
119	}	119	}
120		120
121	static int gxe_bd_init(void)	121	static int gxe_bd_init(void)
122	{	122	{
123	void *vaddr;	123	void *vaddr;
124	int rc, i;	124	int rc, i;
125	char name[16];	125	char name[16];
126		126
127	rc = devmap_driver_register(NAME, gxe_bd_connection);	127	rc = devmap_driver_register(NAME, gxe_bd_connection);
128	if (rc < 0) {	128	if (rc < 0) {
129	printf(NAME ": Unable to register driver.\n");	129	printf(NAME ": Unable to register driver.\n");
130	return rc;	130	return rc;
131	}	131	}
132		132
133	rc = pio_enable((void *) dev_physical, sizeof(gxe_bd_t), &vaddr);	133	rc = pio_enable((void *) dev_physical, sizeof(gxe_bd_t), &vaddr);
134	if (rc != EOK) {	134	if (rc != EOK) {
135	printf(NAME ": Could not initialize device I/O space.\n");	135	printf(NAME ": Could not initialize device I/O space.\n");
136	return rc;	136	return rc;
137	}	137	}
138		138
139	dev = vaddr;	139	dev = vaddr;
140		140
141	for (i = 0; i < MAX_DISKS; i++) {	141	for (i = 0; i < MAX_DISKS; i++) {
142	snprintf(name, 16, "disk%d", i);	142	snprintf(name, 16, "disk%d", i);
143	rc = devmap_device_register(name, &dev_handle[i]);	143	rc = devmap_device_register(name, &dev_handle[i]);
144	if (rc != EOK) {	144	if (rc != EOK) {
145	devmap_hangup_phone(DEVMAP_DRIVER);	145	devmap_hangup_phone(DEVMAP_DRIVER);
146	printf(NAME ": Unable to register device %s.\n",	146	printf(NAME ": Unable to register device %s.\n",
147	name);	147	name);
148	return rc;	148	return rc;
149	}	149	}
150	fibril_mutex_initialize(&dev_lock[i]);	150	fibril_mutex_initialize(&dev_lock[i]);
151	}	151	}
152		152
153	return EOK;	153	return EOK;
154	}	154	}
155		155
156	static void gxe_bd_connection(ipc_callid_t iid, ipc_call_t *icall)	156	static void gxe_bd_connection(ipc_callid_t iid, ipc_call_t *icall)
157	{	157	{
158	void *fs_va = NULL;	158	void *fs_va = NULL;
159	ipc_callid_t callid;	159	ipc_callid_t callid;
160	ipc_call_t call;	160	ipc_call_t call;
161	ipcarg_t method;	161	ipcarg_t method;
162	dev_handle_t dh;	162	dev_handle_t dh;
163	int flags;	163	int flags;
164	int retval;	164	int retval;
165	off_t idx;	165	off_t idx;
166	size_t size;	166	size_t size;
167	int disk_id, i;	167	int disk_id, i;
168		168
169	/* Get the device handle. */	169	/* Get the device handle. */
170	dh = IPC_GET_ARG1(*icall);	170	dh = IPC_GET_ARG1(*icall);
171		171
172	/* Determine which disk device is the client connecting to. */	172	/* Determine which disk device is the client connecting to. */
173	disk_id = -1;	173	disk_id = -1;
174	for (i = 0; i < MAX_DISKS; i++)	174	for (i = 0; i < MAX_DISKS; i++)
175	if (dev_handle[i] == dh)	175	if (dev_handle[i] == dh)
176	disk_id = i;	176	disk_id = i;
177		177
178	if (disk_id < 0) {	178	if (disk_id < 0) {
179	ipc_answer_0(iid, EINVAL);	179	ipc_answer_0(iid, EINVAL);
180	return;	180	return;
181	}	181	}
182		182
183	/* Answer the IPC_M_CONNECT_ME_TO call. */	183	/* Answer the IPC_M_CONNECT_ME_TO call. */
184	ipc_answer_0(iid, EOK);	184	ipc_answer_0(iid, EOK);
185		185
186	if (!ipc_share_out_receive(&callid, &comm_size, &flags)) {	186	if (!ipc_share_out_receive(&callid, &comm_size, &flags)) {
187	ipc_answer_0(callid, EHANGUP);	187	ipc_answer_0(callid, EHANGUP);
188	return;	188	return;
189	}	189	}
190		190
191	fs_va = as_get_mappable_page(comm_size);	191	fs_va = as_get_mappable_page(comm_size);
192	if (fs_va == NULL) {	192	if (fs_va == NULL) {
193	ipc_answer_0(callid, EHANGUP);	193	ipc_answer_0(callid, EHANGUP);
194	return;	194	return;
195	}	195	}
196		196
197	(void) ipc_share_out_finalize(callid, fs_va);	197	(void) ipc_share_out_finalize(callid, fs_va);
198		198
199	while (1) {	199	while (1) {
200	callid = async_get_call(&call);	200	callid = async_get_call(&call);
201	method = IPC_GET_METHOD(call);	201	method = IPC_GET_METHOD(call);
202	switch (method) {	202	switch (method) {
203	case IPC_M_PHONE_HUNGUP:	203	case IPC_M_PHONE_HUNGUP:
204	/* The other side has hung up. */	204	/* The other side has hung up. */
205	ipc_answer_0(callid, EOK);	205	ipc_answer_0(callid, EOK);
206	return;	206	return;
207	case BD_READ_BLOCK:	207	case BD_READ_BLOCK:
208	case BD_WRITE_BLOCK:	208	case BD_WRITE_BLOCK:
209	idx = IPC_GET_ARG1(call);	209	idx = IPC_GET_ARG1(call);
210	size = IPC_GET_ARG2(call);	210	size = IPC_GET_ARG2(call);
211	if (size > comm_size) {	211	if (size > comm_size) {
212	retval = EINVAL;	212	retval = EINVAL;
213	break;	213	break;
214	}	214	}
215	retval = gx_bd_rdwr(disk_id, method, idx * size,	215	retval = gx_bd_rdwr(disk_id, method, idx * size,
216	size, fs_va);	216	size, fs_va);
217	break;	217	break;
218	default:	218	default:
219	retval = EINVAL;	219	retval = EINVAL;
220	break;	220	break;
221	}	221	}
222	ipc_answer_0(callid, retval);	222	ipc_answer_0(callid, retval);
223	}	223	}
224	}	224	}
225		225
226	static int gx_bd_rdwr(int disk_id, ipcarg_t method, off_t offset, size_t size,	226	static int gx_bd_rdwr(int disk_id, ipcarg_t method, off_t offset, size_t size,
227	void *buf)	227	void *buf)
228	{	228	{
229	int rc;	229	int rc;
230	size_t now;	230	size_t now;
231		231
232	while (size > 0) {	232	while (size > 0) {
233	now = size < block_size ? size : block_size;	233	now = size < block_size ? size : block_size;
234		234
235	if (method == BD_READ_BLOCK)	235	if (method == BD_READ_BLOCK)
236	rc = gxe_bd_read_block(disk_id, offset, now, buf);	236	rc = gxe_bd_read_block(disk_id, offset, now, buf);
237	else	237	else
238	rc = gxe_bd_write_block(disk_id, offset, now, buf);	238	rc = gxe_bd_write_block(disk_id, offset, now, buf);
239		239
240	if (rc != EOK)	240	if (rc != EOK)
241	return rc;	241	return rc;
242		242
243	buf += block_size;	243	buf += block_size;
244	offset += block_size;	244	offset += block_size;
245		245
246	if (size > block_size)	246	if (size > block_size)
247	size -= block_size;	247	size -= block_size;
248	else	248	else
249	size = 0;	249	size = 0;
250	}	250	}
251		251
252	return EOK;	252	return EOK;
253	}	253	}
254		254
255	static int gxe_bd_read_block(int disk_id, uint64_t offset, size_t size,	255	static int gxe_bd_read_block(int disk_id, uint64_t offset, size_t size,
256	void *buf)	256	void *buf)
257	{	257	{
258	uint32_t status;	258	uint32_t status;
259	size_t i;	259	size_t i;
260	uint32_t w;	260	uint32_t w;
261		261
262	fibril_mutex_lock(&dev_lock[disk_id]);	262	fibril_mutex_lock(&dev_lock[disk_id]);
263	pio_write_32(&dev->offset_lo, (uint32_t) offset);	263	pio_write_32(&dev->offset_lo, (uint32_t) offset);
264	pio_write_32(&dev->offset_hi, offset >> 32);	264	pio_write_32(&dev->offset_hi, offset >> 32);
265	pio_write_32(&dev->disk_id, disk_id);	265	pio_write_32(&dev->disk_id, disk_id);
266	pio_write_32(&dev->control, CTL_READ_START);	266	pio_write_32(&dev->control, CTL_READ_START);
267		267
268	status = pio_read_32(&dev->status);	268	status = pio_read_32(&dev->status);
269	if (status == STATUS_FAILURE) {	269	if (status == STATUS_FAILURE) {
270	fibril_mutex_unlock(&dev_lock[disk_id]);	270	fibril_mutex_unlock(&dev_lock[disk_id]);
271	return EIO;	271	return EIO;
272	}	272	}
273		273
274	for (i = 0; i < size; i++) {	274	for (i = 0; i < size; i++) {
275	((uint8_t *) buf)[i] = w = pio_read_8(&dev->buffer[i]);	275	((uint8_t *) buf)[i] = w = pio_read_8(&dev->buffer[i]);
276	}	276	}
277		277
278	fibril_mutex_unlock(&dev_lock[disk_id]);	278	fibril_mutex_unlock(&dev_lock[disk_id]);
279	return EOK;	279	return EOK;
280	}	280	}
281		281
282	static int gxe_bd_write_block(int disk_id, uint64_t offset, size_t size,	282	static int gxe_bd_write_block(int disk_id, uint64_t offset, size_t size,
283	const void *buf)	283	const void *buf)
284	{	284	{
285	uint32_t status;	285	uint32_t status;
286	size_t i;	286	size_t i;
287		287
288	for (i = 0; i < size; i++) {	288	for (i = 0; i < size; i++) {
289	pio_write_8(&dev->buffer[i], ((const uint8_t *) buf)[i]);	289	pio_write_8(&dev->buffer[i], ((const uint8_t *) buf)[i]);
290	}	290	}
291		291
292	fibril_mutex_lock(&dev_lock[disk_id]);	292	fibril_mutex_lock(&dev_lock[disk_id]);
293	pio_write_32(&dev->offset_lo, (uint32_t) offset);	293	pio_write_32(&dev->offset_lo, (uint32_t) offset);
294	pio_write_32(&dev->offset_hi, offset >> 32);	294	pio_write_32(&dev->offset_hi, offset >> 32);
295	pio_write_32(&dev->disk_id, disk_id);	295	pio_write_32(&dev->disk_id, disk_id);
296	pio_write_32(&dev->control, CTL_WRITE_START);	296	pio_write_32(&dev->control, CTL_WRITE_START);
297		297
298	status = pio_read_32(&dev->status);	298	status = pio_read_32(&dev->status);
299	if (status == STATUS_FAILURE) {	299	if (status == STATUS_FAILURE) {
300	fibril_mutex_unlock(&dev_lock[disk_id]);	300	fibril_mutex_unlock(&dev_lock[disk_id]);
301	return EIO;	301	return EIO;
302	}	302	}
303		303
304	fibril_mutex_unlock(&dev_lock[disk_id]);	304	fibril_mutex_unlock(&dev_lock[disk_id]);
305	return EOK;	305	return EOK;
306	}	306	}
307		307
308	/**	308	/**
309	* @}	309	* @}
310	*/	310	*/
311		311

Subversion Repositories HelenOS

(root)/branches/dynload/uspace/srv/bd/gxe_bd/gxe_bd.c – Rev 4621 → 4691