Subversion Repositories HelenOS

Rev

Rev 4509 | Rev 4585 | Go to most recent revision | Only display areas with differences | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed

Rev 4509 Rev 4561
1
/*
1
/*
2
 * Copyright (c) 2009 Martin Decky
2
 * Copyright (c) 2009 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 fs
29
/** @addtogroup fs
30
 * @{
30
 * @{
31
 */
31
 */
32
 
32
 
33
/**
33
/**
34
 * @file devfs_ops.c
34
 * @file devfs_ops.c
35
 * @brief Implementation of VFS operations for the devfs file system server.
35
 * @brief Implementation of VFS operations for the devfs file system server.
36
 */
36
 */
37
 
37
 
38
#include <ipc/ipc.h>
38
#include <ipc/ipc.h>
39
#include <bool.h>
39
#include <bool.h>
40
#include <errno.h>
40
#include <errno.h>
41
#include <malloc.h>
41
#include <malloc.h>
42
#include <string.h>
42
#include <string.h>
43
#include <libfs.h>
43
#include <libfs.h>
-
 
44
#include <fibril_sync.h>
44
#include <adt/hash_table.h>
45
#include <adt/hash_table.h>
45
#include "devfs.h"
46
#include "devfs.h"
46
#include "devfs_ops.h"
47
#include "devfs_ops.h"
47
 
48
 
48
#define PLB_GET_CHAR(pos)  (devfs_reg.plb_ro[pos % PLB_SIZE])
49
#define PLB_GET_CHAR(pos)  (devfs_reg.plb_ro[pos % PLB_SIZE])
49
 
50
 
50
/** Opened devices structure */
51
/** Opened devices structure */
51
typedef struct {
52
typedef struct {
52
    dev_handle_t handle;
53
    dev_handle_t handle;
53
    int phone;
54
    int phone;
54
    size_t refcount;
55
    size_t refcount;
55
    link_t link;
56
    link_t link;
56
} device_t;
57
} device_t;
57
 
58
 
58
/** Hash table of opened devices */
59
/** Hash table of opened devices */
59
static hash_table_t devices;
60
static hash_table_t devices;
60
 
61
 
-
 
62
/** Hash table mutex */
-
 
63
static FIBRIL_MUTEX_INITIALIZE(devices_mutex);
-
 
64
 
61
#define DEVICES_KEYS        1
65
#define DEVICES_KEYS        1
62
#define DEVICES_KEY_HANDLE  0
66
#define DEVICES_KEY_HANDLE  0
63
#define DEVICES_BUCKETS     256
67
#define DEVICES_BUCKETS     256
64
 
68
 
65
/* Implementation of hash table interface for the nodes hash table. */
69
/* Implementation of hash table interface for the nodes hash table. */
66
static hash_index_t devices_hash(unsigned long key[])
70
static hash_index_t devices_hash(unsigned long key[])
67
{
71
{
68
    return key[DEVICES_KEY_HANDLE] % DEVICES_BUCKETS;
72
    return key[DEVICES_KEY_HANDLE] % DEVICES_BUCKETS;
69
}
73
}
70
 
74
 
71
static int devices_compare(unsigned long key[], hash_count_t keys, link_t *item)
75
static int devices_compare(unsigned long key[], hash_count_t keys, link_t *item)
72
{
76
{
73
    device_t *dev = hash_table_get_instance(item, device_t, link);
77
    device_t *dev = hash_table_get_instance(item, device_t, link);
74
    return (dev->handle == (dev_handle_t) key[DEVICES_KEY_HANDLE]);
78
    return (dev->handle == (dev_handle_t) key[DEVICES_KEY_HANDLE]);
75
}
79
}
76
 
80
 
77
static void devices_remove_callback(link_t *item)
81
static void devices_remove_callback(link_t *item)
78
{
82
{
79
    free(hash_table_get_instance(item, device_t, link));
83
    free(hash_table_get_instance(item, device_t, link));
80
}
84
}
81
 
85
 
82
static hash_table_operations_t devices_ops = {
86
static hash_table_operations_t devices_ops = {
83
    .hash = devices_hash,
87
    .hash = devices_hash,
84
    .compare = devices_compare,
88
    .compare = devices_compare,
85
    .remove_callback = devices_remove_callback
89
    .remove_callback = devices_remove_callback
86
};
90
};
87
 
91
 
88
bool devfs_init(void)
92
bool devfs_init(void)
89
{
93
{
90
    if (!hash_table_create(&devices, DEVICES_BUCKETS,
94
    if (!hash_table_create(&devices, DEVICES_BUCKETS,
91
        DEVICES_KEYS, &devices_ops))
95
        DEVICES_KEYS, &devices_ops))
92
        return false;
96
        return false;
93
   
97
   
94
    if (devmap_get_phone(DEVMAP_CLIENT, IPC_FLAG_BLOCKING) < 0)
98
    if (devmap_get_phone(DEVMAP_CLIENT, IPC_FLAG_BLOCKING) < 0)
95
        return false;
99
        return false;
96
   
100
   
97
    return true;
101
    return true;
98
}
102
}
99
 
103
 
100
void devfs_mounted(ipc_callid_t rid, ipc_call_t *request)
104
void devfs_mounted(ipc_callid_t rid, ipc_call_t *request)
101
{
105
{
102
    /* Accept the mount options */
106
    /* Accept the mount options */
103
    ipc_callid_t callid;
107
    ipc_callid_t callid;
104
    size_t size;
108
    size_t size;
105
    if (!ipc_data_write_receive(&callid, &size)) {
109
    if (!ipc_data_write_receive(&callid, &size)) {
106
        ipc_answer_0(callid, EINVAL);
110
        ipc_answer_0(callid, EINVAL);
107
        ipc_answer_0(rid, EINVAL);
111
        ipc_answer_0(rid, EINVAL);
108
        return;
112
        return;
109
    }
113
    }
110
   
114
   
111
    char *opts = malloc(size + 1);
115
    char *opts = malloc(size + 1);
112
    if (!opts) {
116
    if (!opts) {
113
        ipc_answer_0(callid, ENOMEM);
117
        ipc_answer_0(callid, ENOMEM);
114
        ipc_answer_0(rid, ENOMEM);
118
        ipc_answer_0(rid, ENOMEM);
115
        return;
119
        return;
116
    }
120
    }
117
   
121
   
118
    ipcarg_t retval = ipc_data_write_finalize(callid, opts, size);
122
    ipcarg_t retval = ipc_data_write_finalize(callid, opts, size);
119
    if (retval != EOK) {
123
    if (retval != EOK) {
120
        ipc_answer_0(rid, retval);
124
        ipc_answer_0(rid, retval);
121
        free(opts);
125
        free(opts);
122
        return;
126
        return;
123
    }
127
    }
124
   
128
   
125
    free(opts);
129
    free(opts);
126
   
130
   
127
    ipc_answer_3(rid, EOK, 0, 0, 0);
131
    ipc_answer_3(rid, EOK, 0, 0, 0);
128
}
132
}
129
 
133
 
130
void devfs_mount(ipc_callid_t rid, ipc_call_t *request)
134
void devfs_mount(ipc_callid_t rid, ipc_call_t *request)
131
{
135
{
132
    ipc_answer_0(rid, ENOTSUP);
136
    ipc_answer_0(rid, ENOTSUP);
133
}
137
}
134
 
138
 
135
void devfs_lookup(ipc_callid_t rid, ipc_call_t *request)
139
void devfs_lookup(ipc_callid_t rid, ipc_call_t *request)
136
{
140
{
137
    ipcarg_t first = IPC_GET_ARG1(*request);
141
    ipcarg_t first = IPC_GET_ARG1(*request);
138
    ipcarg_t last = IPC_GET_ARG2(*request);
142
    ipcarg_t last = IPC_GET_ARG2(*request);
139
    dev_handle_t dev_handle = IPC_GET_ARG3(*request);
143
    dev_handle_t dev_handle = IPC_GET_ARG3(*request);
140
    ipcarg_t lflag = IPC_GET_ARG4(*request);
144
    ipcarg_t lflag = IPC_GET_ARG4(*request);
141
    fs_index_t index = IPC_GET_ARG5(*request);
145
    fs_index_t index = IPC_GET_ARG5(*request);
142
   
146
   
143
    /* Hierarchy is flat, no altroot is supported */
147
    /* Hierarchy is flat, no altroot is supported */
144
    if (index != 0) {
148
    if (index != 0) {
145
        ipc_answer_0(rid, ENOENT);
149
        ipc_answer_0(rid, ENOENT);
146
        return;
150
        return;
147
    }
151
    }
148
   
152
   
149
    if ((lflag & L_LINK) || (lflag & L_UNLINK)) {
153
    if ((lflag & L_LINK) || (lflag & L_UNLINK)) {
150
        ipc_answer_0(rid, ENOTSUP);
154
        ipc_answer_0(rid, ENOTSUP);
151
        return;
155
        return;
152
    }
156
    }
153
   
157
   
154
    /* Eat slash */
158
    /* Eat slash */
155
    if (PLB_GET_CHAR(first) == '/') {
159
    if (PLB_GET_CHAR(first) == '/') {
156
        first++;
160
        first++;
157
        first %= PLB_SIZE;
161
        first %= PLB_SIZE;
158
    }
162
    }
159
   
163
   
160
    if (first >= last) {
164
    if (first >= last) {
161
        /* Root entry */
165
        /* Root entry */
162
        if (lflag & L_DIRECTORY)
166
        if (lflag & L_DIRECTORY)
163
            ipc_answer_5(rid, EOK, devfs_reg.fs_handle, dev_handle, 0, 0, 0);
167
            ipc_answer_5(rid, EOK, devfs_reg.fs_handle, dev_handle, 0, 0, 0);
164
        else
168
        else
165
            ipc_answer_0(rid, ENOENT);
169
            ipc_answer_0(rid, ENOENT);
166
    } else {
170
    } else {
167
        if (lflag & L_FILE) {
171
        if (lflag & L_FILE) {
168
            size_t len;
172
            size_t len;
169
            if (last >= first)
173
            if (last >= first)
170
                len = last - first + 1;
174
                len = last - first + 1;
171
            else
175
            else
172
                len = first + PLB_SIZE - last + 1;
176
                len = first + PLB_SIZE - last + 1;
173
           
177
           
174
            char *name = (char *) malloc(len + 1);
178
            char *name = (char *) malloc(len + 1);
175
            if (name == NULL) {
179
            if (name == NULL) {
176
                ipc_answer_0(rid, ENOMEM);
180
                ipc_answer_0(rid, ENOMEM);
177
                return;
181
                return;
178
            }
182
            }
179
           
183
           
180
            size_t i;
184
            size_t i;
181
            for (i = 0; i < len; i++)
185
            for (i = 0; i < len; i++)
182
                name[i] = PLB_GET_CHAR(first + i);
186
                name[i] = PLB_GET_CHAR(first + i);
183
           
187
           
184
            name[len] = 0;
188
            name[len] = 0;
185
           
189
           
186
            dev_handle_t handle;
190
            dev_handle_t handle;
187
            if (devmap_device_get_handle(name, &handle, 0) != EOK) {
191
            if (devmap_device_get_handle(name, &handle, 0) != EOK) {
188
                free(name);
192
                free(name);
189
                ipc_answer_0(rid, ENOENT);
193
                ipc_answer_0(rid, ENOENT);
190
                return;
194
                return;
191
            }
195
            }
192
           
196
           
193
            if (lflag & L_OPEN) {
197
            if (lflag & L_OPEN) {
194
                unsigned long key[] = {
198
                unsigned long key[] = {
195
                    [DEVICES_KEY_HANDLE] = (unsigned long) handle
199
                    [DEVICES_KEY_HANDLE] = (unsigned long) handle
196
                };
200
                };
197
               
201
               
-
 
202
                fibril_mutex_lock(&devices_mutex);
198
                link_t *lnk = hash_table_find(&devices, key);
203
                link_t *lnk = hash_table_find(&devices, key);
199
                if (lnk == NULL) {
204
                if (lnk == NULL) {
200
                    int phone = devmap_device_connect(handle, 0);
205
                    int phone = devmap_device_connect(handle, 0);
201
                    if (phone < 0) {
206
                    if (phone < 0) {
-
 
207
                        fibril_mutex_unlock(&devices_mutex);
202
                        free(name);
208
                        free(name);
203
                        ipc_answer_0(rid, ENOENT);
209
                        ipc_answer_0(rid, ENOENT);
204
                        return;
210
                        return;
205
                    }
211
                    }
206
                   
212
                   
207
                    device_t *dev = (device_t *) malloc(sizeof(device_t));
213
                    device_t *dev = (device_t *) malloc(sizeof(device_t));
208
                    if (dev == NULL) {
214
                    if (dev == NULL) {
-
 
215
                        fibril_mutex_unlock(&devices_mutex);
209
                        free(name);
216
                        free(name);
210
                        ipc_answer_0(rid, ENOMEM);
217
                        ipc_answer_0(rid, ENOMEM);
211
                        return;
218
                        return;
212
                    }
219
                    }
213
                   
220
                   
214
                    dev->handle = handle;
221
                    dev->handle = handle;
215
                    dev->phone = phone;
222
                    dev->phone = phone;
216
                    dev->refcount = 1;
223
                    dev->refcount = 1;
217
                   
224
                   
218
                    hash_table_insert(&devices, key, &dev->link);
225
                    hash_table_insert(&devices, key, &dev->link);
219
                } else {
226
                } else {
220
                    device_t *dev = hash_table_get_instance(lnk, device_t, link);
227
                    device_t *dev = hash_table_get_instance(lnk, device_t, link);
221
                    dev->refcount++;
228
                    dev->refcount++;
222
                }
229
                }
-
 
230
                fibril_mutex_unlock(&devices_mutex);
223
            }
231
            }
224
           
232
           
225
            free(name);
233
            free(name);
226
           
234
           
227
            ipc_answer_5(rid, EOK, devfs_reg.fs_handle, dev_handle, handle, 0, 1);
235
            ipc_answer_5(rid, EOK, devfs_reg.fs_handle, dev_handle, handle, 0, 1);
228
        } else
236
        } else
229
            ipc_answer_0(rid, ENOENT);
237
            ipc_answer_0(rid, ENOENT);
230
    }
238
    }
231
}
239
}
232
 
240
 
233
void devfs_open_node(ipc_callid_t rid, ipc_call_t *request)
241
void devfs_open_node(ipc_callid_t rid, ipc_call_t *request)
234
{
242
{
235
    dev_handle_t handle = IPC_GET_ARG2(*request);
243
    dev_handle_t handle = IPC_GET_ARG2(*request);
236
   
244
   
237
    unsigned long key[] = {
245
    unsigned long key[] = {
238
        [DEVICES_KEY_HANDLE] = (unsigned long) handle
246
        [DEVICES_KEY_HANDLE] = (unsigned long) handle
239
    };
247
    };
240
   
248
   
-
 
249
    fibril_mutex_lock(&devices_mutex);
241
    link_t *lnk = hash_table_find(&devices, key);
250
    link_t *lnk = hash_table_find(&devices, key);
242
    if (lnk == NULL) {
251
    if (lnk == NULL) {
243
        int phone = devmap_device_connect(handle, 0);
252
        int phone = devmap_device_connect(handle, 0);
244
        if (phone < 0) {
253
        if (phone < 0) {
-
 
254
            fibril_mutex_unlock(&devices_mutex);
245
            ipc_answer_0(rid, ENOENT);
255
            ipc_answer_0(rid, ENOENT);
246
            return;
256
            return;
247
        }
257
        }
248
       
258
       
249
        device_t *dev = (device_t *) malloc(sizeof(device_t));
259
        device_t *dev = (device_t *) malloc(sizeof(device_t));
250
        if (dev == NULL) {
260
        if (dev == NULL) {
-
 
261
            fibril_mutex_unlock(&devices_mutex);
251
            ipc_answer_0(rid, ENOMEM);
262
            ipc_answer_0(rid, ENOMEM);
252
            return;
263
            return;
253
        }
264
        }
254
       
265
       
255
        dev->handle = handle;
266
        dev->handle = handle;
256
        dev->phone = phone;
267
        dev->phone = phone;
257
        dev->refcount = 1;
268
        dev->refcount = 1;
258
       
269
       
259
        hash_table_insert(&devices, key, &dev->link);
270
        hash_table_insert(&devices, key, &dev->link);
260
    } else {
271
    } else {
261
        device_t *dev = hash_table_get_instance(lnk, device_t, link);
272
        device_t *dev = hash_table_get_instance(lnk, device_t, link);
262
        dev->refcount++;
273
        dev->refcount++;
263
    }
274
    }
-
 
275
    fibril_mutex_unlock(&devices_mutex);
264
   
276
   
265
    ipc_answer_3(rid, EOK, 0, 1, L_FILE);
277
    ipc_answer_3(rid, EOK, 0, 1, L_FILE);
266
}
278
}
267
 
279
 
268
void devfs_device(ipc_callid_t rid, ipc_call_t *request)
280
void devfs_device(ipc_callid_t rid, ipc_call_t *request)
269
{
281
{
270
    fs_index_t index = (fs_index_t) IPC_GET_ARG2(*request);
282
    fs_index_t index = (fs_index_t) IPC_GET_ARG2(*request);
271
   
283
   
272
    if (index != 0) {
284
    if (index != 0) {
273
        unsigned long key[] = {
285
        unsigned long key[] = {
274
            [DEVICES_KEY_HANDLE] = (unsigned long) index
286
            [DEVICES_KEY_HANDLE] = (unsigned long) index
275
        };
287
        };
276
       
288
       
-
 
289
        fibril_mutex_lock(&devices_mutex);
277
        link_t *lnk = hash_table_find(&devices, key);
290
        link_t *lnk = hash_table_find(&devices, key);
278
        if (lnk == NULL) {
291
        if (lnk == NULL) {
-
 
292
            fibril_mutex_unlock(&devices_mutex);
279
            ipc_answer_0(rid, ENOENT);
293
            ipc_answer_0(rid, ENOENT);
280
            return;
294
            return;
281
        }
295
        }
-
 
296
        fibril_mutex_unlock(&devices_mutex);
282
       
297
       
283
        ipc_answer_1(rid, EOK, (ipcarg_t) index);
298
        ipc_answer_1(rid, EOK, (ipcarg_t) index);
284
    } else
299
    } else
285
        ipc_answer_0(rid, ENOTSUP);
300
        ipc_answer_0(rid, ENOTSUP);
286
}
301
}
287
 
302
 
288
void devfs_read(ipc_callid_t rid, ipc_call_t *request)
303
void devfs_read(ipc_callid_t rid, ipc_call_t *request)
289
{
304
{
290
    fs_index_t index = (fs_index_t) IPC_GET_ARG2(*request);
305
    fs_index_t index = (fs_index_t) IPC_GET_ARG2(*request);
291
    off_t pos = (off_t) IPC_GET_ARG3(*request);
306
    off_t pos = (off_t) IPC_GET_ARG3(*request);
292
   
307
   
293
    if (index != 0) {
308
    if (index != 0) {
294
        unsigned long key[] = {
309
        unsigned long key[] = {
295
            [DEVICES_KEY_HANDLE] = (unsigned long) index
310
            [DEVICES_KEY_HANDLE] = (unsigned long) index
296
        };
311
        };
297
       
312
       
-
 
313
        fibril_mutex_lock(&devices_mutex);
298
        link_t *lnk = hash_table_find(&devices, key);
314
        link_t *lnk = hash_table_find(&devices, key);
299
        if (lnk == NULL) {
315
        if (lnk == NULL) {
-
 
316
            fibril_mutex_unlock(&devices_mutex);
300
            ipc_answer_0(rid, ENOENT);
317
            ipc_answer_0(rid, ENOENT);
301
            return;
318
            return;
302
        }
319
        }
303
       
320
       
304
        device_t *dev = hash_table_get_instance(lnk, device_t, link);
321
        device_t *dev = hash_table_get_instance(lnk, device_t, link);
305
       
322
       
306
        ipc_callid_t callid;
323
        ipc_callid_t callid;
307
        if (!ipc_data_read_receive(&callid, NULL)) {
324
        if (!ipc_data_read_receive(&callid, NULL)) {
-
 
325
            fibril_mutex_unlock(&devices_mutex);
308
            ipc_answer_0(callid, EINVAL);
326
            ipc_answer_0(callid, EINVAL);
309
            ipc_answer_0(rid, EINVAL);
327
            ipc_answer_0(rid, EINVAL);
310
            return;
328
            return;
311
        }
329
        }
312
       
330
       
313
        /* Make a request at the driver */
331
        /* Make a request at the driver */
314
        ipc_call_t answer;
332
        ipc_call_t answer;
315
        aid_t msg = async_send_3(dev->phone, IPC_GET_METHOD(*request),
333
        aid_t msg = async_send_3(dev->phone, IPC_GET_METHOD(*request),
316
            IPC_GET_ARG1(*request), IPC_GET_ARG2(*request),
334
            IPC_GET_ARG1(*request), IPC_GET_ARG2(*request),
317
            IPC_GET_ARG3(*request), &answer);
335
            IPC_GET_ARG3(*request), &answer);
318
       
336
       
319
        /* Forward the IPC_M_DATA_READ request to the driver */
337
        /* Forward the IPC_M_DATA_READ request to the driver */
320
        ipc_forward_fast(callid, dev->phone, 0, 0, 0, IPC_FF_ROUTE_FROM_ME);
338
        ipc_forward_fast(callid, dev->phone, 0, 0, 0, IPC_FF_ROUTE_FROM_ME);
-
 
339
        fibril_mutex_unlock(&devices_mutex);
321
       
340
       
322
        /* Wait for reply from the driver. */
341
        /* Wait for reply from the driver. */
323
        ipcarg_t rc;
342
        ipcarg_t rc;
324
        async_wait_for(msg, &rc);
343
        async_wait_for(msg, &rc);
325
        size_t bytes = IPC_GET_ARG1(answer);
344
        size_t bytes = IPC_GET_ARG1(answer);
326
       
345
       
327
        /* Driver reply is the final result of the whole operation */
346
        /* Driver reply is the final result of the whole operation */
328
        ipc_answer_1(rid, rc, bytes);
347
        ipc_answer_1(rid, rc, bytes);
329
    } else {
348
    } else {
330
        ipc_callid_t callid;
349
        ipc_callid_t callid;
331
        size_t size;
350
        size_t size;
332
        if (!ipc_data_read_receive(&callid, &size)) {
351
        if (!ipc_data_read_receive(&callid, &size)) {
333
            ipc_answer_0(callid, EINVAL);
352
            ipc_answer_0(callid, EINVAL);
334
            ipc_answer_0(rid, EINVAL);
353
            ipc_answer_0(rid, EINVAL);
335
            return;
354
            return;
336
        }
355
        }
337
       
356
       
338
        size_t count = devmap_device_get_count();
357
        size_t count = devmap_device_get_count();
339
        dev_desc_t *desc = malloc(count * sizeof(dev_desc_t));
358
        dev_desc_t *desc = malloc(count * sizeof(dev_desc_t));
340
        if (desc == NULL) {
359
        if (desc == NULL) {
341
            ipc_answer_0(callid, ENOMEM);
360
            ipc_answer_0(callid, ENOMEM);
342
            ipc_answer_1(rid, ENOMEM, 0);
361
            ipc_answer_1(rid, ENOMEM, 0);
343
            return;
362
            return;
344
        }
363
        }
345
       
364
       
346
        size_t max = devmap_device_get_devices(count, desc);
365
        size_t max = devmap_device_get_devices(count, desc);
347
       
366
       
348
        if (pos < max) {
367
        if (pos < max) {
349
            ipc_data_read_finalize(callid, desc[pos].name, str_size(desc[pos].name) + 1);
368
            ipc_data_read_finalize(callid, desc[pos].name, str_size(desc[pos].name) + 1);
350
        } else {
369
        } else {
351
            ipc_answer_0(callid, ENOENT);
370
            ipc_answer_0(callid, ENOENT);
352
            ipc_answer_1(rid, ENOENT, 0);
371
            ipc_answer_1(rid, ENOENT, 0);
353
            return;
372
            return;
354
        }
373
        }
355
       
374
       
356
        free(desc);
375
        free(desc);
357
       
376
       
358
        ipc_answer_1(rid, EOK, 1);
377
        ipc_answer_1(rid, EOK, 1);
359
    }
378
    }
360
}
379
}
361
 
380
 
362
void devfs_write(ipc_callid_t rid, ipc_call_t *request)
381
void devfs_write(ipc_callid_t rid, ipc_call_t *request)
363
{
382
{
364
    fs_index_t index = (fs_index_t) IPC_GET_ARG2(*request);
383
    fs_index_t index = (fs_index_t) IPC_GET_ARG2(*request);
365
    off_t pos = (off_t) IPC_GET_ARG3(*request);
384
    off_t pos = (off_t) IPC_GET_ARG3(*request);
366
   
385
   
367
    if (index != 0) {
386
    if (index != 0) {
368
        unsigned long key[] = {
387
        unsigned long key[] = {
369
            [DEVICES_KEY_HANDLE] = (unsigned long) index
388
            [DEVICES_KEY_HANDLE] = (unsigned long) index
370
        };
389
        };
371
       
390
       
-
 
391
        fibril_mutex_lock(&devices_mutex);
372
        link_t *lnk = hash_table_find(&devices, key);
392
        link_t *lnk = hash_table_find(&devices, key);
373
        if (lnk == NULL) {
393
        if (lnk == NULL) {
-
 
394
            fibril_mutex_unlock(&devices_mutex);
374
            ipc_answer_0(rid, ENOENT);
395
            ipc_answer_0(rid, ENOENT);
375
            return;
396
            return;
376
        }
397
        }
377
       
398
       
378
        device_t *dev = hash_table_get_instance(lnk, device_t, link);
399
        device_t *dev = hash_table_get_instance(lnk, device_t, link);
379
       
400
       
380
        ipc_callid_t callid;
401
        ipc_callid_t callid;
381
        if (!ipc_data_write_receive(&callid, NULL)) {
402
        if (!ipc_data_write_receive(&callid, NULL)) {
-
 
403
            fibril_mutex_unlock(&devices_mutex);
382
            ipc_answer_0(callid, EINVAL);
404
            ipc_answer_0(callid, EINVAL);
383
            ipc_answer_0(rid, EINVAL);
405
            ipc_answer_0(rid, EINVAL);
384
            return;
406
            return;
385
        }
407
        }
386
       
408
       
387
        /* Make a request at the driver */
409
        /* Make a request at the driver */
388
        ipc_call_t answer;
410
        ipc_call_t answer;
389
        aid_t msg = async_send_3(dev->phone, IPC_GET_METHOD(*request),
411
        aid_t msg = async_send_3(dev->phone, IPC_GET_METHOD(*request),
390
            IPC_GET_ARG1(*request), IPC_GET_ARG2(*request),
412
            IPC_GET_ARG1(*request), IPC_GET_ARG2(*request),
391
            IPC_GET_ARG3(*request), &answer);
413
            IPC_GET_ARG3(*request), &answer);
392
       
414
       
393
        /* Forward the IPC_M_DATA_WRITE request to the driver */
415
        /* Forward the IPC_M_DATA_WRITE request to the driver */
394
        ipc_forward_fast(callid, dev->phone, 0, 0, 0, IPC_FF_ROUTE_FROM_ME);
416
        ipc_forward_fast(callid, dev->phone, 0, 0, 0, IPC_FF_ROUTE_FROM_ME);
395
       
417
       
-
 
418
        fibril_mutex_unlock(&devices_mutex);
-
 
419
       
396
        /* Wait for reply from the driver. */
420
        /* Wait for reply from the driver. */
397
        ipcarg_t rc;
421
        ipcarg_t rc;
398
        async_wait_for(msg, &rc);
422
        async_wait_for(msg, &rc);
399
        size_t bytes = IPC_GET_ARG1(answer);
423
        size_t bytes = IPC_GET_ARG1(answer);
400
       
424
       
401
        /* Driver reply is the final result of the whole operation */
425
        /* Driver reply is the final result of the whole operation */
402
        ipc_answer_1(rid, rc, bytes);
426
        ipc_answer_1(rid, rc, bytes);
403
    } else {
427
    } else {
404
        /* Read-only filesystem */
428
        /* Read-only filesystem */
405
        ipc_answer_0(rid, ENOTSUP);
429
        ipc_answer_0(rid, ENOTSUP);
406
    }
430
    }
407
}
431
}
408
 
432
 
409
void devfs_truncate(ipc_callid_t rid, ipc_call_t *request)
433
void devfs_truncate(ipc_callid_t rid, ipc_call_t *request)
410
{
434
{
411
    ipc_answer_0(rid, ENOTSUP);
435
    ipc_answer_0(rid, ENOTSUP);
412
}
436
}
413
 
437
 
414
void devfs_close(ipc_callid_t rid, ipc_call_t *request)
438
void devfs_close(ipc_callid_t rid, ipc_call_t *request)
415
{
439
{
416
    fs_index_t index = (fs_index_t) IPC_GET_ARG2(*request);
440
    fs_index_t index = (fs_index_t) IPC_GET_ARG2(*request);
417
   
441
   
418
    if (index != 0) {
442
    if (index != 0) {
419
        unsigned long key[] = {
443
        unsigned long key[] = {
420
            [DEVICES_KEY_HANDLE] = (unsigned long) index
444
            [DEVICES_KEY_HANDLE] = (unsigned long) index
421
        };
445
        };
422
       
446
       
-
 
447
        fibril_mutex_lock(&devices_mutex);
423
        link_t *lnk = hash_table_find(&devices, key);
448
        link_t *lnk = hash_table_find(&devices, key);
424
        if (lnk == NULL) {
449
        if (lnk == NULL) {
-
 
450
            fibril_mutex_unlock(&devices_mutex);
425
            ipc_answer_0(rid, ENOENT);
451
            ipc_answer_0(rid, ENOENT);
426
            return;
452
            return;
427
        }
453
        }
428
       
454
       
429
        device_t *dev = hash_table_get_instance(lnk, device_t, link);
455
        device_t *dev = hash_table_get_instance(lnk, device_t, link);
430
        dev->refcount--;
456
        dev->refcount--;
431
       
457
       
432
        if (dev->refcount == 0) {
458
        if (dev->refcount == 0) {
433
            ipc_hangup(dev->phone);
459
            ipc_hangup(dev->phone);
434
            hash_table_remove(&devices, key, DEVICES_KEYS);
460
            hash_table_remove(&devices, key, DEVICES_KEYS);
435
        }
461
        }
436
       
462
       
-
 
463
        fibril_mutex_unlock(&devices_mutex);
-
 
464
       
437
        ipc_answer_0(rid, EOK);
465
        ipc_answer_0(rid, EOK);
438
    } else
466
    } else
439
        ipc_answer_0(rid, ENOTSUP);
467
        ipc_answer_0(rid, ENOTSUP);
440
}
468
}
441
 
469
 
442
void devfs_sync(ipc_callid_t rid, ipc_call_t *request)
470
void devfs_sync(ipc_callid_t rid, ipc_call_t *request)
443
{
471
{
444
    fs_index_t index = (fs_index_t) IPC_GET_ARG2(*request);
472
    fs_index_t index = (fs_index_t) IPC_GET_ARG2(*request);
445
   
473
   
446
    if (index != 0) {
474
    if (index != 0) {
447
        unsigned long key[] = {
475
        unsigned long key[] = {
448
            [DEVICES_KEY_HANDLE] = (unsigned long) index
476
            [DEVICES_KEY_HANDLE] = (unsigned long) index
449
        };
477
        };
450
       
478
       
-
 
479
        fibril_mutex_lock(&devices_mutex);
451
        link_t *lnk = hash_table_find(&devices, key);
480
        link_t *lnk = hash_table_find(&devices, key);
452
        if (lnk == NULL) {
481
        if (lnk == NULL) {
-
 
482
            fibril_mutex_unlock(&devices_mutex);
453
            ipc_answer_0(rid, ENOENT);
483
            ipc_answer_0(rid, ENOENT);
454
            return;
484
            return;
455
        }
485
        }
456
       
486
       
457
        device_t *dev = hash_table_get_instance(lnk, device_t, link);
487
        device_t *dev = hash_table_get_instance(lnk, device_t, link);
458
       
488
       
459
        /* Make a request at the driver */
489
        /* Make a request at the driver */
460
        ipc_call_t answer;
490
        ipc_call_t answer;
461
        aid_t msg = async_send_2(dev->phone, IPC_GET_METHOD(*request),
491
        aid_t msg = async_send_2(dev->phone, IPC_GET_METHOD(*request),
462
            IPC_GET_ARG1(*request), IPC_GET_ARG2(*request), &answer);
492
            IPC_GET_ARG1(*request), IPC_GET_ARG2(*request), &answer);
463
       
493
       
-
 
494
        fibril_mutex_unlock(&devices_mutex);
-
 
495
       
464
        /* Wait for reply from the driver */
496
        /* Wait for reply from the driver */
465
        ipcarg_t rc;
497
        ipcarg_t rc;
466
        async_wait_for(msg, &rc);
498
        async_wait_for(msg, &rc);
467
       
499
       
468
        /* Driver reply is the final result of the whole operation */
500
        /* Driver reply is the final result of the whole operation */
469
        ipc_answer_0(rid, rc);
501
        ipc_answer_0(rid, rc);
470
    } else
502
    } else
471
        ipc_answer_0(rid, ENOTSUP);
503
        ipc_answer_0(rid, ENOTSUP);
472
}
504
}
473
 
505
 
474
void devfs_destroy(ipc_callid_t rid, ipc_call_t *request)
506
void devfs_destroy(ipc_callid_t rid, ipc_call_t *request)
475
{
507
{
476
    ipc_answer_0(rid, ENOTSUP);
508
    ipc_answer_0(rid, ENOTSUP);
477
}
509
}
478
 
510
 
479
/**
511
/**
480
 * @}
512
 * @}
481
 */
513
 */
482
 
514