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

Subversion Repositories HelenOS

(root)/branches/network/uspace/srv/bd/gxe_bd/gxe_bd.c – Rev 4581 → 4718