Subversion Repositories HelenOS

Rev

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

Rev 3901 Rev 3912
1
/*
1
/*
2
 * Copyright (c) 2008 Lukas Mejdrech
2
 * Copyright (c) 2009 Lukas Mejdrech
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 net
29
/** @addtogroup packet
30
 *  @{
30
 *  @{
31
 */
31
 */
32
 
32
 
33
/** @file
33
/** @file
-
 
34
 *  Packet server implementation.
34
 */
35
 */
35
 
36
 
36
#include <async.h>
37
#include <async.h>
37
#include <align.h>
38
#include <align.h>
38
#include <errno.h>
39
#include <errno.h>
39
//#include <stdio.h>
40
//#include <stdio.h>
40
#include <unistd.h>
41
#include <unistd.h>
41
 
42
 
42
#include <ipc/ipc.h>
43
#include <ipc/ipc.h>
43
#include <ipc/services.h>
44
#include <ipc/services.h>
44
#include <sys/mman.h>
45
#include <sys/mman.h>
45
 
46
 
46
#include "../../err.h"
47
#include "../../err.h"
47
#include "../../messages.h"
48
#include "../../messages.h"
48
 
49
 
49
#include "packet.h"
50
#include "packet.h"
50
#include "packet_header.h"
51
#include "packet_header.h"
51
#include "packet_server.h"
52
#include "packet_server.h"
52
 
53
 
-
 
54
/** Returns the packet identifier message parameter.
-
 
55
 */
53
#define IPC_GET_ID( call )          ( packet_id_t ) IPC_GET_ARG1( * call )
56
#define IPC_GET_ID( call )          ( packet_id_t ) IPC_GET_ARG1( * call )
-
 
57
 
-
 
58
/** Returns the owner message parameter.
-
 
59
 */
54
#define IPC_GET_OWNER( call )       ( services_t ) IPC_GET_ARG1( * call )
60
#define IPC_GET_OWNER( call )       ( services_t ) IPC_GET_ARG1( * call )
-
 
61
 
-
 
62
/** Returns the maximal content length message parameter.
-
 
63
 */
55
#define IPC_GET_CONTENT( call )     ( size_t ) IPC_GET_ARG2( * call )
64
#define IPC_GET_CONTENT( call )     ( size_t ) IPC_GET_ARG2( * call )
-
 
65
 
-
 
66
/** Returns the maximal address length message parameter.
-
 
67
 */
56
#define IPC_GET_ADDR_LEN( call )    ( size_t ) IPC_GET_ARG3( * call )
68
#define IPC_GET_ADDR_LEN( call )    ( size_t ) IPC_GET_ARG3( * call )
-
 
69
 
-
 
70
/** Returns the maximal prefix length message parameter.
-
 
71
 */
57
#define IPC_GET_PREFIX( call )      ( size_t ) IPC_GET_ARG4( * call )
72
#define IPC_GET_PREFIX( call )      ( size_t ) IPC_GET_ARG4( * call )
-
 
73
 
-
 
74
/** Returns the maximal suffix length message parameter.
-
 
75
 */
58
#define IPC_GET_SUFIX( call )       ( size_t ) IPC_GET_ARG5( * call )
76
#define IPC_GET_SUFIX( call )       ( size_t ) IPC_GET_ARG5( * call )
59
 
77
 
60
#define FREE_QUEUES_COUNT   7
78
#define FREE_QUEUES_COUNT   7
61
 
79
 
-
 
80
/** Packet server global data.
-
 
81
 */
62
static struct{
82
static struct{
-
 
83
    /** Free packet queues.
-
 
84
     */
63
    packet_t free[ FREE_QUEUES_COUNT ];
85
    packet_t free[ FREE_QUEUES_COUNT ];
-
 
86
    /** Packet length upper bounds of the free packet queues.
-
 
87
     *  The maximal lengths of packets in each queue in the ascending order.
-
 
88
     *  The last queue is not limited.
-
 
89
     */
64
    int sizes[ FREE_QUEUES_COUNT ];
90
    int sizes[ FREE_QUEUES_COUNT ];
-
 
91
    /** Total packets allocated.
-
 
92
     */
65
    unsigned int count;
93
    unsigned int count;
66
} ps_globals = {
94
} ps_globals = {
67
    { NULL, NULL, NULL, NULL, NULL, NULL, NULL },
95
    { NULL, NULL, NULL, NULL, NULL, NULL, NULL },
68
    { PAGE_SIZE, PAGE_SIZE * 2, PAGE_SIZE * 4, PAGE_SIZE * 8, PAGE_SIZE * 16, PAGE_SIZE * 32, PAGE_SIZE * 64 },
96
    { PAGE_SIZE, PAGE_SIZE * 2, PAGE_SIZE * 4, PAGE_SIZE * 8, PAGE_SIZE * 16, PAGE_SIZE * 32, PAGE_SIZE * 64 },
69
    0
97
    0
70
};
98
};
71
 
99
 
-
 
100
/** Releases the packet and returns it to the appropriate free packet queue.
-
 
101
 *  @param packet The packet to be released. Input parameter.
-
 
102
 */
72
void packet_release( packet_t packet );
103
void packet_release( packet_t packet );
-
 
104
 
-
 
105
/** Returns the packet of dimensions at least as given.
-
 
106
 *  Tries to reuse free packets first.
-
 
107
 *  Creates a&nbsp;new packet aligned to the memory page size if none available.
-
 
108
 *  @param owner The new owner of the packet. Input parameter.
-
 
109
 *  @param addr_len The source and destination addresses maximal length in bytes. Input parameter.
-
 
110
 *  @param max_prefix The maximal prefix length in bytes. Input parameter.
-
 
111
 *  @param max_content The maximal content length in bytes. Input parameter.
-
 
112
 *  @param max_suffix The maximal suffix length in bytes. Input parameter.
-
 
113
 *  @returns The packet of dimensions at least as given.
-
 
114
 *  @returns NULL if there is not enough memory left.
-
 
115
 */
73
packet_t packet_get( services_t owner, size_t addr_len, size_t max_prefix, size_t max_content, size_t max_sufix );
116
packet_t packet_get( services_t owner, size_t addr_len, size_t max_prefix, size_t max_content, size_t max_suffix );
-
 
117
 
-
 
118
/** Creates a&nbsp;new packet of dimensions at least as given.
-
 
119
 *  @param length The total length of the packet, including the header, the addresses and the data of the packet. Input parameter.
-
 
120
 *  @param owner The new owner of the packet. Input parameter.
-
 
121
 *  @param addr_len The source and destination addresses maximal length in bytes. Input parameter.
-
 
122
 *  @param max_prefix The maximal prefix length in bytes. Input parameter.
-
 
123
 *  @param max_content The maximal content length in bytes. Input parameter.
-
 
124
 *  @param max_suffix The maximal suffix length in bytes. Input parameter.
-
 
125
 *  @returns The packet of dimensions at least as given.
-
 
126
 *  @returns NULL if there is not enough memory left.
-
 
127
 */
74
packet_t    packet_create( size_t length, services_t owner, size_t addr_len, size_t max_prefix, size_t max_content, size_t max_sufix );
128
packet_t    packet_create( size_t length, services_t owner, size_t addr_len, size_t max_prefix, size_t max_content, size_t max_suffix );
-
 
129
 
-
 
130
/** Initializes the packet according to the given dimensions.
-
 
131
 *  @param packet The packet to be initialized. Input parameter.
-
 
132
 *  @param owner The new owner of the packet. Input parameter.
-
 
133
 *  @param addr_len The source and destination addresses maximal length in bytes. Input parameter.
-
 
134
 *  @param max_prefix The maximal prefix length in bytes. Input parameter.
-
 
135
 *  @param max_content The maximal content length in bytes. Input parameter.
-
 
136
 *  @param max_suffix The maximal suffix length in bytes. Input parameter.
-
 
137
 */
75
void    packet_init( packet_t packet, services_t owner, size_t addr_len, size_t max_prefix, size_t max_content, size_t max_sufix );
138
void    packet_init( packet_t packet, services_t owner, size_t addr_len, size_t max_prefix, size_t max_content, size_t max_suffix );
-
 
139
 
-
 
140
/** Shares the packet memory block.
-
 
141
 *  @param packet The packet to be shared.
-
 
142
 *  @returns EOK on success.
-
 
143
 *  @returns EINVAL if the packet is not valid.
-
 
144
 *  @returns EINVAL if the calling module does not accept the memory.
-
 
145
 *  @returns ENOMEM if the desired and actual sizes differ.
-
 
146
 *  @returns Other error codes as defined for the ipc_share_in_finalize() function.
-
 
147
 */
76
int packet_reply( const packet_t packet );
148
int packet_reply( const packet_t packet );
77
 
149
 
78
int packet_server_message( ipc_callid_t callid, ipc_call_t * call, ipc_call_t * answer, int * answer_count ){
150
int packet_server_message( ipc_callid_t callid, ipc_call_t * call, ipc_call_t * answer, int * answer_count ){
79
    packet_t packet;
151
    packet_t packet;
80
 
152
 
81
    * answer_count = 0;
153
    * answer_count = 0;
82
    switch( IPC_GET_METHOD( * call )){
154
    switch( IPC_GET_METHOD( * call )){
83
        case IPC_M_PHONE_HUNGUP:
155
        case IPC_M_PHONE_HUNGUP:
84
            return EOK;
156
            return EOK;
85
        case NET_PACKET_CREATE_1:
157
        case NET_PACKET_CREATE_1:
86
            packet = packet_get( IPC_GET_OWNER( call ), 0, 0, IPC_GET_CONTENT( call ), 0 );
158
            packet = packet_get( IPC_GET_OWNER( call ), 0, 0, IPC_GET_CONTENT( call ), 0 );
87
            if( ! packet ) return ENOMEM;
159
            if( ! packet ) return ENOMEM;
88
            * answer_count = 2;
160
            * answer_count = 2;
89
            IPC_SET_ARG1( * answer, packet->packet_id );
161
            IPC_SET_ARG1( * answer, packet->packet_id );
90
            IPC_SET_ARG2( * answer, packet->length );
162
            IPC_SET_ARG2( * answer, packet->length );
91
            return EOK;
163
            return EOK;
92
        case NET_PACKET_CREATE_5:
164
        case NET_PACKET_CREATE_5:
93
            packet = packet_get( IPC_GET_OWNER( call ), IPC_GET_ADDR_LEN( call ), IPC_GET_PREFIX( call ), IPC_GET_CONTENT( call ), IPC_GET_SUFIX( call ));
165
            packet = packet_get( IPC_GET_OWNER( call ), IPC_GET_ADDR_LEN( call ), IPC_GET_PREFIX( call ), IPC_GET_CONTENT( call ), IPC_GET_SUFIX( call ));
94
            if( ! packet ) return ENOMEM;
166
            if( ! packet ) return ENOMEM;
95
            * answer_count = 2;
167
            * answer_count = 2;
96
            IPC_SET_ARG1( * answer, packet->packet_id );
168
            IPC_SET_ARG1( * answer, packet->packet_id );
97
            IPC_SET_ARG2( * answer, packet->length );
169
            IPC_SET_ARG2( * answer, packet->length );
98
            return EOK;
170
            return EOK;
99
        case NET_PACKET_GET:
171
        case NET_PACKET_GET:
100
            packet = pm_find( IPC_GET_ID( call ));
172
            packet = pm_find( IPC_GET_ID( call ));
101
            if( ! packet_is_valid( packet )) return ENOENT;
173
            if( ! packet_is_valid( packet )) return ENOENT;
102
            return packet_reply( packet );
174
            return packet_reply( packet );
103
        case NET_PACKET_GET_SIZE:
175
        case NET_PACKET_GET_SIZE:
104
            packet = pm_find( IPC_GET_ID( call ));
176
            packet = pm_find( IPC_GET_ID( call ));
105
            if( ! packet_is_valid( packet )) return ENOENT;
177
            if( ! packet_is_valid( packet )) return ENOENT;
106
            * answer_count = 1;
178
            * answer_count = 1;
107
            IPC_SET_ARG1( * answer, packet->length );
179
            IPC_SET_ARG1( * answer, packet->length );
108
            return EOK;
180
            return EOK;
109
        case NET_PACKET_RELEASE:
181
        case NET_PACKET_RELEASE:
110
            packet = pm_find( IPC_GET_ID( call ));
182
            packet = pm_find( IPC_GET_ID( call ));
111
            if( ! packet_is_valid( packet )) return ENOENT;
183
            if( ! packet_is_valid( packet )) return ENOENT;
112
            pq_destroy( packet, packet_release );
184
            pq_destroy( packet, packet_release );
113
            return EOK;
185
            return EOK;
114
    }
186
    }
115
    return ENOTSUP;
187
    return ENOTSUP;
116
}
188
}
117
 
189
 
118
void packet_release( packet_t packet ){
190
void packet_release( packet_t packet ){
119
    int index;
191
    int index;
120
 
192
 
121
    for( index = 0; ( index < FREE_QUEUES_COUNT - 1 ) && ( packet->length > ps_globals.sizes[ index ] ); ++ index );
193
    for( index = 0; ( index < FREE_QUEUES_COUNT - 1 ) && ( packet->length > ps_globals.sizes[ index ] ); ++ index );
122
    ps_globals.free[ index ] = pq_add( ps_globals.free[ index ], packet, packet->length, packet->length );
194
    ps_globals.free[ index ] = pq_add( ps_globals.free[ index ], packet, packet->length, packet->length );
123
}
195
}
124
 
196
 
125
packet_t packet_get( services_t owner, size_t addr_len, size_t max_prefix, size_t max_content, size_t max_sufix ){
197
packet_t packet_get( services_t owner, size_t addr_len, size_t max_prefix, size_t max_content, size_t max_suffix ){
126
    int index;
198
    int index;
127
    packet_t packet;
199
    packet_t packet;
128
    size_t length;
200
    size_t length;
129
 
201
 
130
    length = ALIGN_UP( sizeof( struct packet ) + 2 * addr_len + max_prefix + max_content + max_sufix, PAGE_SIZE );
202
    length = ALIGN_UP( sizeof( struct packet ) + 2 * addr_len + max_prefix + max_content + max_suffix, PAGE_SIZE );
131
    for( index = 0; index < FREE_QUEUES_COUNT - 1; ++ index ){
203
    for( index = 0; index < FREE_QUEUES_COUNT - 1; ++ index ){
132
        if( length <= ps_globals.sizes[ index ] ){
204
        if( length <= ps_globals.sizes[ index ] ){
133
            packet = ps_globals.free[ index ];
205
            packet = ps_globals.free[ index ];
134
            while( packet_is_valid( packet ) && ( packet->length < length )){
206
            while( packet_is_valid( packet ) && ( packet->length < length )){
135
                packet = pm_find( packet->next );
207
                packet = pm_find( packet->next );
136
            }
208
            }
137
            if( packet ){
209
            if( packet ){
138
                packet_init( packet, owner, addr_len, max_prefix, max_content, max_sufix );
210
                packet_init( packet, owner, addr_len, max_prefix, max_content, max_suffix );
139
                return packet;
211
                return packet;
140
            }
212
            }
141
        }
213
        }
142
    }
214
    }
143
    return packet_create( length, owner, addr_len, max_prefix, max_content, max_sufix );
215
    return packet_create( length, owner, addr_len, max_prefix, max_content, max_suffix );
144
}
216
}
145
 
217
 
146
packet_t packet_create( size_t length, services_t owner, size_t addr_len, size_t max_prefix, size_t max_content, size_t max_sufix ){
218
packet_t packet_create( size_t length, services_t owner, size_t addr_len, size_t max_prefix, size_t max_content, size_t max_suffix ){
147
    ERROR_DECLARE;
219
    ERROR_DECLARE;
148
 
220
 
149
    packet_t    packet;
221
    packet_t    packet;
150
 
222
 
151
    packet = ( packet_t ) mmap( NULL, length, PROTO_READ | PROTO_WRITE, MAP_SHARED | MAP_ANONYMOUS, 0, 0 );
223
    packet = ( packet_t ) mmap( NULL, length, PROTO_READ | PROTO_WRITE, MAP_SHARED | MAP_ANONYMOUS, 0, 0 );
152
    if( packet == MAP_FAILED ) return NULL;
224
    if( packet == MAP_FAILED ) return NULL;
153
    ++ ps_globals.count;
225
    ++ ps_globals.count;
154
    packet->packet_id = ps_globals.count;
226
    packet->packet_id = ps_globals.count;
155
    packet->mode = PM_ONEWAY;
227
    packet->mode = PM_ONE_WAY;
156
    packet->length = length;
228
    packet->length = length;
157
    packet_init( packet, owner, addr_len, max_prefix, max_content, max_sufix );
229
    packet_init( packet, owner, addr_len, max_prefix, max_content, max_suffix );
158
    packet->magic_value = PACKET_MAGIC_VALUE;
230
    packet->magic_value = PACKET_MAGIC_VALUE;
159
    if( ERROR_OCCURED( pm_add( packet ))){
231
    if( ERROR_OCCURRED( pm_add( packet ))){
160
        munmap( packet, packet->length );
232
        munmap( packet, packet->length );
161
        return NULL;
233
        return NULL;
162
    }
234
    }
163
    packet_release( packet );
235
    packet_release( packet );
164
    return packet;
236
    return packet;
165
}
237
}
166
 
238
 
167
void packet_init( packet_t packet, services_t owner, size_t addr_len, size_t max_prefix, size_t max_content, size_t max_sufix ){
239
void packet_init( packet_t packet, services_t owner, size_t addr_len, size_t max_prefix, size_t max_content, size_t max_suffix ){
168
    packet->owner = owner;
240
    packet->owner = owner;
169
    packet->order = 0;
241
    packet->order = 0;
170
    packet->metric = 0;
242
    packet->metric = 0;
171
    packet->previous = 0;
243
    packet->previous = 0;
172
    packet->next = 0;
244
    packet->next = 0;
173
    packet->addr_len = addr_len;
245
    packet->addr_len = addr_len;
174
    packet->src_addr = sizeof( struct packet );
246
    packet->src_addr = sizeof( struct packet );
175
    packet->dest_addr = packet->src_addr + packet->addr_len;
247
    packet->dest_addr = packet->src_addr + packet->addr_len;
176
    packet->max_prefix = max_prefix;
248
    packet->max_prefix = max_prefix;
177
    packet->max_content = max_content;
249
    packet->max_content = max_content;
178
    packet->data_start = packet->dest_addr + packet->addr_len + packet->max_prefix;
250
    packet->data_start = packet->dest_addr + packet->addr_len + packet->max_prefix;
179
    packet->data_end = packet->data_start;
251
    packet->data_end = packet->data_start;
180
}
252
}
181
 
253
 
182
int packet_reply( const packet_t packet ){
254
int packet_reply( const packet_t packet ){
183
    ipc_callid_t    callid;
255
    ipc_callid_t    callid;
184
    size_t          size;
256
    size_t          size;
185
 
257
 
186
    if( ! packet_is_valid( packet )) return EINVAL;
258
    if( ! packet_is_valid( packet )) return EINVAL;
187
    if( ipc_share_in_receive( & callid, & size ) <= 0 ) return EINVAL;
259
    if( ipc_share_in_receive( & callid, & size ) <= 0 ) return EINVAL;
188
    if( size != packet->length ) return ENOMEM;
260
    if( size != packet->length ) return ENOMEM;
189
    return ipc_share_in_finalize( callid, packet, PROTO_READ | PROTO_WRITE );
261
    return ipc_share_in_finalize( callid, packet, PROTO_READ | PROTO_WRITE );
190
}
262
}
191
 
263
 
192
/** @}
264
/** @}
193
 */
265
 */
194
 
266