Subversion Repositories HelenOS

Rev

Rev 3191 | Rev 4344 | Go to most recent revision | Details | Compare with Previous | Last modification | View Log | RSS feed

Rev Author Line No. Line
1 jermar 1
/*
2071 jermar 2
 * Copyright (c) 2001-2005 Jakub Jermar
3
 * Copyright (c) 2005 Sergey Bondari
1 jermar 4
 * All rights reserved.
5
 *
6
 * Redistribution and use in source and binary forms, with or without
7
 * modification, are permitted provided that the following conditions
8
 * are met:
9
 *
10
 * - Redistributions of source code must retain the above copyright
11
 *   notice, this list of conditions and the following disclaimer.
12
 * - Redistributions in binary form must reproduce the above copyright
13
 *   notice, this list of conditions and the following disclaimer in the
14
 *   documentation and/or other materials provided with the distribution.
15
 * - The name of the author may not be used to endorse or promote products
16
 *   derived from this software without specific prior written permission.
17
 *
18
 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
19
 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
20
 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
21
 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
22
 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
23
 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
24
 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
25
 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
26
 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
27
 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
28
 */
29
 
1757 jermar 30
/** @addtogroup genericmm
1702 cejka 31
 * @{
32
 */
33
 
1248 jermar 34
/**
1702 cejka 35
 * @file
1248 jermar 36
 * @brief   Physical frame allocator.
37
 *
38
 * This file contains the physical frame allocator and memory zone management.
39
 * The frame allocator is built on top of the buddy allocator.
40
 *
41
 * @see buddy.c
42
 */
43
 
814 palkovsky 44
/*
45
 * Locking order
46
 *
47
 * In order to access particular zone, the process must first lock
48
 * the zones.lock, then lock the zone and then unlock the zones.lock.
49
 * This insures, that we can fiddle with the zones in runtime without
50
 * affecting the processes.
51
 *
52
 */
53
 
1 jermar 54
#include <arch/types.h>
55
#include <mm/frame.h>
703 jermar 56
#include <mm/as.h>
1 jermar 57
#include <panic.h>
367 jermar 58
#include <debug.h>
788 jermar 59
#include <adt/list.h>
1 jermar 60
#include <synch/spinlock.h>
3191 svoboda 61
#include <synch/mutex.h>
62
#include <synch/condvar.h>
115 jermar 63
#include <arch/asm.h>
195 vana 64
#include <arch.h>
533 bondari 65
#include <print.h>
536 bondari 66
#include <align.h>
814 palkovsky 67
#include <mm/slab.h>
822 palkovsky 68
#include <bitops.h>
1063 palkovsky 69
#include <macros.h>
2128 jermar 70
#include <config.h>
115 jermar 71
 
814 palkovsky 72
typedef struct {
73
    count_t refcount;   /**< tracking of shared frames  */
1780 jermar 74
    uint8_t buddy_order;    /**< buddy system block order */
2133 jermar 75
    link_t buddy_link;  /**< link to the next free block inside one
76
                     order */
814 palkovsky 77
    void *parent;           /**< If allocated by slab, this points there */
1236 jermar 78
} frame_t;
367 jermar 79
 
814 palkovsky 80
typedef struct {
81
    SPINLOCK_DECLARE(lock); /**< this lock protects everything below */
2133 jermar 82
    pfn_t base;     /**< frame_no of the first frame in the frames
83
                     array */
820 jermar 84
    count_t count;          /**< Size of zone */
533 bondari 85
 
2133 jermar 86
    frame_t *frames;    /**< array of frame_t structures in this
87
                     zone */
814 palkovsky 88
    count_t free_count; /**< number of free frame_t structures */
89
    count_t busy_count; /**< number of busy frame_t structures */
90
 
2059 jermar 91
    buddy_system_t *buddy_system; /**< buddy system for the zone */
814 palkovsky 92
    int flags;
1236 jermar 93
} zone_t;
479 bondari 94
 
814 palkovsky 95
/*
96
 * The zoneinfo.lock must be locked when accessing zoneinfo structure.
97
 * Some of the attributes in zone_t structures are 'read-only'
368 jermar 98
 */
1 jermar 99
 
2121 decky 100
typedef struct {
814 palkovsky 101
    SPINLOCK_DECLARE(lock);
2122 decky 102
    unsigned int count;
814 palkovsky 103
    zone_t *info[ZONES_MAX];
2121 decky 104
} zones_t;
1 jermar 105
 
2121 decky 106
static zones_t zones;
814 palkovsky 107
 
3191 svoboda 108
/*
109
 * Synchronization primitives used to sleep when there is no memory
110
 * available.
111
 */
112
mutex_t mem_avail_mtx;
113
condvar_t mem_avail_cv;
114
unsigned long mem_avail_frames = 0; /**< Number of available frames. */
115
unsigned long mem_avail_gen = 0;    /**< Generation counter. */
2121 decky 116
 
2725 decky 117
/********************/
814 palkovsky 118
/* Helper functions */
2725 decky 119
/********************/
120
 
814 palkovsky 121
static inline index_t frame_index(zone_t *zone, frame_t *frame)
762 palkovsky 122
{
2725 decky 123
    return (index_t) (frame - zone->frames);
762 palkovsky 124
}
2725 decky 125
 
814 palkovsky 126
static inline index_t frame_index_abs(zone_t *zone, frame_t *frame)
1 jermar 127
{
2725 decky 128
    return (index_t) (frame - zone->frames) + zone->base;
1 jermar 129
}
2725 decky 130
 
814 palkovsky 131
static inline int frame_index_valid(zone_t *zone, index_t index)
132
{
2745 decky 133
    return (index < zone->count);
814 palkovsky 134
}
1 jermar 135
 
814 palkovsky 136
/** Compute pfn_t from frame_t pointer & zone pointer */
820 jermar 137
static index_t make_frame_index(zone_t *zone, frame_t *frame)
762 palkovsky 138
{
2725 decky 139
    return (frame - zone->frames);
762 palkovsky 140
}
141
 
3191 svoboda 142
/** Initialize frame structure.
762 palkovsky 143
 *
3191 svoboda 144
 * @param frame     Frame structure to be initialized.
762 palkovsky 145
 */
814 palkovsky 146
static void frame_initialize(frame_t *frame)
762 palkovsky 147
{
814 palkovsky 148
    frame->refcount = 1;
149
    frame->buddy_order = 0;
762 palkovsky 150
}
151
 
2725 decky 152
/**********************/
814 palkovsky 153
/* Zoneinfo functions */
2725 decky 154
/**********************/
762 palkovsky 155
 
3191 svoboda 156
/** Insert-sort zone into zones list.
822 palkovsky 157
 *
3191 svoboda 158
 * @param newzone   New zone to be inserted into zone list.
159
 * @return      Zone number on success, -1 on error.
1 jermar 160
 */
822 palkovsky 161
static int zones_add_zone(zone_t *newzone)
1 jermar 162
{
2122 decky 163
    unsigned int i, j;
822 palkovsky 164
    ipl_t ipl;
165
    zone_t *z;
762 palkovsky 166
 
822 palkovsky 167
    ipl = interrupts_disable();
814 palkovsky 168
    spinlock_lock(&zones.lock);
2725 decky 169
 
814 palkovsky 170
    /* Try to merge */
2725 decky 171
    if (zones.count + 1 == ZONES_MAX) {
172
        printf("Maximum zone count %u exceeded!\n", ZONES_MAX);
173
        spinlock_unlock(&zones.lock);
174
        interrupts_restore(ipl);
175
        return -1;
176
    }
177
 
1037 decky 178
    for (i = 0; i < zones.count; i++) {
822 palkovsky 179
        /* Check for overflow */
852 palkovsky 180
        z = zones.info[i];
3191 svoboda 181
        if (overlaps(newzone->base, newzone->count, z->base,
182
            z->count)) {
822 palkovsky 183
            printf("Zones overlap!\n");
184
            return -1;
814 palkovsky 185
        }
852 palkovsky 186
        if (newzone->base < z->base)
822 palkovsky 187
            break;
368 jermar 188
    }
2725 decky 189
 
822 palkovsky 190
    /* Move other zones up */
2133 jermar 191
    for (j = i; j < zones.count; j++)
1037 decky 192
        zones.info[j + 1] = zones.info[j];
2725 decky 193
 
822 palkovsky 194
    zones.info[i] = newzone;
195
    zones.count++;
2725 decky 196
 
814 palkovsky 197
    spinlock_unlock(&zones.lock);
822 palkovsky 198
    interrupts_restore(ipl);
199
 
200
    return i;
1 jermar 201
}
202
 
3211 svoboda 203
/** Try to find a zone where can we find the frame.
2725 decky 204
 *
2059 jermar 205
 * Assume interrupts are disabled.
2725 decky 206
 *
3191 svoboda 207
 * @param frame     Frame number contained in zone.
208
 * @param pzone     If not null, it is used as zone hint. Zone index is
209
 *          filled into the variable on success.
210
 * @return      Pointer to locked zone containing frame.
368 jermar 211
 */
3191 svoboda 212
static zone_t *find_zone_and_lock(pfn_t frame, unsigned int *pzone)
1 jermar 213
{
2122 decky 214
    unsigned int i;
215
    unsigned int hint = pzone ? *pzone : 0;
814 palkovsky 216
    zone_t *z;
533 bondari 217
 
814 palkovsky 218
    spinlock_lock(&zones.lock);
219
 
2745 decky 220
    if (hint >= zones.count)
814 palkovsky 221
        hint = 0;
533 bondari 222
 
814 palkovsky 223
    i = hint;
224
    do {
225
        z = zones.info[i];
226
        spinlock_lock(&z->lock);
227
        if (z->base <= frame && z->base + z->count > frame) {
2133 jermar 228
            /* Unlock the global lock */
229
            spinlock_unlock(&zones.lock);
814 palkovsky 230
            if (pzone)
231
                *pzone = i;
232
            return z;
533 bondari 233
        }
814 palkovsky 234
        spinlock_unlock(&z->lock);
533 bondari 235
 
814 palkovsky 236
        i++;
237
        if (i >= zones.count)
238
            i = 0;
3211 svoboda 239
    } while (i != hint);
814 palkovsky 240
 
241
    spinlock_unlock(&zones.lock);
242
    return NULL;
533 bondari 243
}
244
 
822 palkovsky 245
/** @return True if zone can allocate specified order */
1780 jermar 246
static int zone_can_alloc(zone_t *z, uint8_t order)
822 palkovsky 247
{
248
    return buddy_system_can_alloc(z->buddy_system, order);
249
}
250
 
2059 jermar 251
/** Find and lock zone that can allocate order frames.
367 jermar 252
 *
2059 jermar 253
 * Assume interrupts are disabled.
367 jermar 254
 *
3191 svoboda 255
 * @param order     Size (2^order) of free space we are trying to find.
3211 svoboda 256
 * @param flags     Required flags of the target zone.
3191 svoboda 257
 * @param pzone     Pointer to preferred zone or NULL, on return contains
258
 *          zone number.
367 jermar 259
 */
3211 svoboda 260
static zone_t *
261
find_free_zone_and_lock(uint8_t order, int flags, unsigned int *pzone)
367 jermar 262
{
2122 decky 263
    unsigned int i;
367 jermar 264
    zone_t *z;
2122 decky 265
    unsigned int hint = pzone ? *pzone : 0;
367 jermar 266
 
3211 svoboda 267
    /* Mask off flags that are not applicable. */
268
    flags &= FRAME_LOW_4_GiB;
269
 
814 palkovsky 270
    spinlock_lock(&zones.lock);
271
    if (hint >= zones.count)
272
        hint = 0;
273
    i = hint;
274
    do {
275
        z = zones.info[i];
724 palkovsky 276
 
814 palkovsky 277
        spinlock_lock(&z->lock);
367 jermar 278
 
3211 svoboda 279
        /*
280
         * Check whether the zone meets the search criteria.
281
         */
282
        if ((z->flags & flags) == flags) {
283
            /*
284
             * Check if the zone has 2^order frames area available.
285
             */
286
            if (zone_can_alloc(z, order)) {
287
                spinlock_unlock(&zones.lock);
288
                if (pzone)
289
                    *pzone = i;
290
                return z;
291
            }
367 jermar 292
        }
814 palkovsky 293
        spinlock_unlock(&z->lock);
294
        if (++i >= zones.count)
295
            i = 0;
3211 svoboda 296
    } while (i != hint);
814 palkovsky 297
    spinlock_unlock(&zones.lock);
298
    return NULL;
367 jermar 299
}
300
 
2059 jermar 301
/**************************/
814 palkovsky 302
/* Buddy system functions */
2059 jermar 303
/**************************/
814 palkovsky 304
 
3191 svoboda 305
/** Buddy system find_block implementation.
367 jermar 306
 *
814 palkovsky 307
 * Find block that is parent of current list.
308
 * That means go to lower addresses, until such block is found
367 jermar 309
 *
3191 svoboda 310
 * @param order     Order of parent must be different then this
311
 *          parameter!!
367 jermar 312
 */
814 palkovsky 313
static link_t *zone_buddy_find_block(buddy_system_t *b, link_t *child,
2133 jermar 314
    uint8_t order)
367 jermar 315
{
2133 jermar 316
    frame_t *frame;
317
    zone_t *zone;
814 palkovsky 318
    index_t index;
367 jermar 319
 
814 palkovsky 320
    frame = list_get_instance(child, frame_t, buddy_link);
321
    zone = (zone_t *) b->data;
367 jermar 322
 
814 palkovsky 323
    index = frame_index(zone, frame);
324
    do {
325
        if (zone->frames[index].buddy_order != order) {
326
            return &zone->frames[index].buddy_link;
327
        }
328
    } while(index-- > 0);
329
    return NULL;
367 jermar 330
}
479 bondari 331
 
3191 svoboda 332
/** Buddy system find_buddy implementation.
489 jermar 333
 *
3191 svoboda 334
 * @param b     Buddy system.
335
 * @param block     Block for which buddy should be found.
479 bondari 336
 *
3191 svoboda 337
 * @return      Buddy for given block if found.
479 bondari 338
 */
2133 jermar 339
static link_t *zone_buddy_find_buddy(buddy_system_t *b, link_t *block)
814 palkovsky 340
{
2133 jermar 341
    frame_t *frame;
342
    zone_t *zone;
564 jermar 343
    index_t index;
480 bondari 344
    bool is_left, is_right;
479 bondari 345
 
480 bondari 346
    frame = list_get_instance(block, frame_t, buddy_link);
533 bondari 347
    zone = (zone_t *) b->data;
2133 jermar 348
    ASSERT(IS_BUDDY_ORDER_OK(frame_index_abs(zone, frame),
349
        frame->buddy_order));
480 bondari 350
 
724 palkovsky 351
    is_left = IS_BUDDY_LEFT_BLOCK_ABS(zone, frame);
352
    is_right = IS_BUDDY_RIGHT_BLOCK_ABS(zone, frame);
814 palkovsky 353
 
564 jermar 354
    ASSERT(is_left ^ is_right);
533 bondari 355
    if (is_left) {
3191 svoboda 356
        index = (frame_index(zone, frame)) +
357
            (1 << frame->buddy_order);
1981 jermar 358
    } else {    /* if (is_right) */
3191 svoboda 359
        index = (frame_index(zone, frame)) -
360
            (1 << frame->buddy_order);
533 bondari 361
    }
362
 
814 palkovsky 363
    if (frame_index_valid(zone, index)) {
364
        if (zone->frames[index].buddy_order == frame->buddy_order &&
365
            zone->frames[index].refcount == 0) {
533 bondari 366
            return &zone->frames[index].buddy_link;
480 bondari 367
        }
368
    }
814 palkovsky 369
 
539 jermar 370
    return NULL;   
479 bondari 371
}
372
 
3191 svoboda 373
/** Buddy system bisect implementation.
479 bondari 374
 *
3191 svoboda 375
 * @param b     Buddy system.
376
 * @param block     Block to bisect.
480 bondari 377
 *
3191 svoboda 378
 * @return      Right block.
479 bondari 379
 */
3191 svoboda 380
static link_t *zone_buddy_bisect(buddy_system_t *b, link_t *block)
381
{
2133 jermar 382
    frame_t *frame_l, *frame_r;
564 jermar 383
 
480 bondari 384
    frame_l = list_get_instance(block, frame_t, buddy_link);
533 bondari 385
    frame_r = (frame_l + (1 << (frame_l->buddy_order - 1)));
564 jermar 386
 
480 bondari 387
    return &frame_r->buddy_link;
479 bondari 388
}
389
 
3191 svoboda 390
/** Buddy system coalesce implementation.
479 bondari 391
 *
3191 svoboda 392
 * @param b     Buddy system.
393
 * @param block_1   First block.
394
 * @param block_2   First block's buddy.
480 bondari 395
 *
3191 svoboda 396
 * @return      Coalesced block (actually block that represents lower
397
 *          address).
479 bondari 398
 */
2133 jermar 399
static link_t *zone_buddy_coalesce(buddy_system_t *b, link_t *block_1,
400
    link_t *block_2)
822 palkovsky 401
{
814 palkovsky 402
    frame_t *frame1, *frame2;
564 jermar 403
 
480 bondari 404
    frame1 = list_get_instance(block_1, frame_t, buddy_link);
405
    frame2 = list_get_instance(block_2, frame_t, buddy_link);
564 jermar 406
 
533 bondari 407
    return frame1 < frame2 ? block_1 : block_2;
479 bondari 408
}
409
 
3191 svoboda 410
/** Buddy system set_order implementation.
489 jermar 411
 *
3191 svoboda 412
 * @param b     Buddy system.
413
 * @param block     Buddy system block.
414
 * @param order     Order to set.
479 bondari 415
 */
2133 jermar 416
static void zone_buddy_set_order(buddy_system_t *b, link_t *block,
3191 svoboda 417
    uint8_t order)
418
{
2133 jermar 419
    frame_t *frame;
480 bondari 420
    frame = list_get_instance(block, frame_t, buddy_link);
421
    frame->buddy_order = order;
479 bondari 422
}
423
 
3191 svoboda 424
/** Buddy system get_order implementation.
489 jermar 425
 *
3191 svoboda 426
 * @param b     Buddy system.
427
 * @param block     Buddy system block.
479 bondari 428
 *
3191 svoboda 429
 * @return      Order of block.
479 bondari 430
 */
3191 svoboda 431
static uint8_t zone_buddy_get_order(buddy_system_t *b, link_t *block)
432
{
2133 jermar 433
    frame_t *frame;
480 bondari 434
    frame = list_get_instance(block, frame_t, buddy_link);
435
    return frame->buddy_order;
479 bondari 436
}
533 bondari 437
 
3191 svoboda 438
/** Buddy system mark_busy implementation.
533 bondari 439
 *
3191 svoboda 440
 * @param b     Buddy system.
441
 * @param block     Buddy system block.
533 bondari 442
 */
3191 svoboda 443
static void zone_buddy_mark_busy(buddy_system_t *b, link_t * block)
444
{
533 bondari 445
    frame_t * frame;
822 palkovsky 446
 
533 bondari 447
    frame = list_get_instance(block, frame_t, buddy_link);
448
    frame->refcount = 1;
449
}
676 bondari 450
 
3191 svoboda 451
/** Buddy system mark_available implementation.
814 palkovsky 452
 *
3191 svoboda 453
 * @param b     Buddy system.
454
 * @param block     Buddy system block.
814 palkovsky 455
 */
3191 svoboda 456
static void zone_buddy_mark_available(buddy_system_t *b, link_t *block)
457
{
2133 jermar 458
    frame_t *frame;
814 palkovsky 459
    frame = list_get_instance(block, frame_t, buddy_link);
460
    frame->refcount = 0;
461
}
462
 
2083 decky 463
static buddy_system_operations_t zone_buddy_system_operations = {
814 palkovsky 464
    .find_buddy = zone_buddy_find_buddy,
465
    .bisect = zone_buddy_bisect,
466
    .coalesce = zone_buddy_coalesce,
467
    .set_order = zone_buddy_set_order,
468
    .get_order = zone_buddy_get_order,
469
    .mark_busy = zone_buddy_mark_busy,
470
    .mark_available = zone_buddy_mark_available,
3211 svoboda 471
    .find_block = zone_buddy_find_block
814 palkovsky 472
};
473
 
2059 jermar 474
/******************/
814 palkovsky 475
/* Zone functions */
2059 jermar 476
/******************/
814 palkovsky 477
 
3191 svoboda 478
/** Allocate frame in particular zone.
814 palkovsky 479
 *
3191 svoboda 480
 * Assume zone is locked.
1269 decky 481
 * Panics if allocation is impossible.
814 palkovsky 482
 *
3191 svoboda 483
 * @param zone      Zone to allocate from.
484
 * @param order     Allocate exactly 2^order frames.
1269 decky 485
 *
3191 svoboda 486
 * @return      Frame index in zone.
1269 decky 487
 *
814 palkovsky 488
 */
1780 jermar 489
static pfn_t zone_frame_alloc(zone_t *zone, uint8_t order)
814 palkovsky 490
{
491
    pfn_t v;
492
    link_t *tmp;
493
    frame_t *frame;
494
 
495
    /* Allocate frames from zone buddy system */
496
    tmp = buddy_system_alloc(zone->buddy_system, order);
497
 
498
    ASSERT(tmp);
499
 
500
    /* Update zone information. */
501
    zone->free_count -= (1 << order);
502
    zone->busy_count += (1 << order);
503
 
504
    /* Frame will be actually a first frame of the block. */
505
    frame = list_get_instance(tmp, frame_t, buddy_link);
506
 
507
    /* get frame address */
508
    v = make_frame_index(zone, frame);
509
    return v;
510
}
511
 
3191 svoboda 512
/** Free frame from zone.
814 palkovsky 513
 *
3191 svoboda 514
 * Assume zone is locked.
1568 palkovsky 515
 *
3191 svoboda 516
 * @param zone      Pointer to zone from which the frame is to be freed.
517
 * @param frame_idx Frame index relative to zone.
814 palkovsky 518
 */
820 jermar 519
static void zone_frame_free(zone_t *zone, index_t frame_idx)
814 palkovsky 520
{
521
    frame_t *frame;
1780 jermar 522
    uint8_t order;
814 palkovsky 523
 
524
    frame = &zone->frames[frame_idx];
525
 
526
    /* remember frame order */
527
    order = frame->buddy_order;
528
 
529
    ASSERT(frame->refcount);
530
 
531
    if (!--frame->refcount) {
532
        buddy_system_free(zone->buddy_system, &frame->buddy_link);
946 jermar 533
 
534
        /* Update zone information. */
535
        zone->free_count += (1 << order);
536
        zone->busy_count -= (1 << order);
814 palkovsky 537
    }
538
}
539
 
3191 svoboda 540
/** Return frame from zone. */
541
static frame_t *zone_get_frame(zone_t *zone, index_t frame_idx)
814 palkovsky 542
{
543
    ASSERT(frame_idx < zone->count);
544
    return &zone->frames[frame_idx];
545
}
546
 
3191 svoboda 547
/** Mark frame in zone unavailable to allocation. */
820 jermar 548
static void zone_mark_unavailable(zone_t *zone, index_t frame_idx)
814 palkovsky 549
{
550
    frame_t *frame;
551
    link_t *link;
552
 
553
    frame = zone_get_frame(zone, frame_idx);
822 palkovsky 554
    if (frame->refcount)
555
        return;
2133 jermar 556
    link = buddy_system_alloc_block(zone->buddy_system,
557
        &frame->buddy_link);
814 palkovsky 558
    ASSERT(link);
559
    zone->free_count--;
3191 svoboda 560
 
561
    mutex_lock(&mem_avail_mtx);
562
    mem_avail_frames--;
563
    mutex_unlock(&mem_avail_mtx);
814 palkovsky 564
}
565
 
3191 svoboda 566
/** Join two zones.
822 palkovsky 567
 *
3191 svoboda 568
 * Expect zone_t *z to point to space at least zone_conf_size large.
822 palkovsky 569
 *
3191 svoboda 570
 * Assume z1 & z2 are locked.
1568 palkovsky 571
 *
3191 svoboda 572
 * @param z     Target zone structure pointer.
573
 * @param z1        Zone to merge.
574
 * @param z2        Zone to merge.
822 palkovsky 575
 */
576
static void _zone_merge(zone_t *z, zone_t *z1, zone_t *z2)
577
{
1780 jermar 578
    uint8_t max_order;
2122 decky 579
    unsigned int i;
580
    int z2idx;
822 palkovsky 581
    pfn_t frame_idx;
582
    frame_t *frame;
583
 
2133 jermar 584
    ASSERT(!overlaps(z1->base, z1->count, z2->base, z2->count));
822 palkovsky 585
    ASSERT(z1->base < z2->base);
586
 
587
    spinlock_initialize(&z->lock, "zone_lock");
588
    z->base = z1->base;
2133 jermar 589
    z->count = z2->base + z2->count - z1->base;
822 palkovsky 590
    z->flags = z1->flags & z2->flags;
591
 
592
    z->free_count = z1->free_count + z2->free_count;
593
    z->busy_count = z1->busy_count + z2->busy_count;
594
 
595
    max_order = fnzb(z->count);
596
 
2133 jermar 597
    z->buddy_system = (buddy_system_t *) &z[1];
598
    buddy_system_create(z->buddy_system, max_order,
599
        &zone_buddy_system_operations, (void *) z);
822 palkovsky 600
 
2133 jermar 601
    z->frames = (frame_t *)((uint8_t *) z->buddy_system +
602
        buddy_conf_size(max_order));
822 palkovsky 603
    for (i = 0; i < z->count; i++) {
604
        /* This marks all frames busy */
605
        frame_initialize(&z->frames[i]);
606
    }
607
    /* Copy frames from both zones to preserve full frame orders,
1093 palkovsky 608
     * parents etc. Set all free frames with refcount=0 to 1, because
822 palkovsky 609
     * we add all free frames to buddy allocator later again, clear
1093 palkovsky 610
     * order to 0. Don't set busy frames with refcount=0, as they
611
     * will not be reallocated during merge and it would make later
612
     * problems with allocation/free.
822 palkovsky 613
     */
2122 decky 614
    for (i = 0; i < z1->count; i++)
822 palkovsky 615
        z->frames[i] = z1->frames[i];
2122 decky 616
    for (i = 0; i < z2->count; i++) {
822 palkovsky 617
        z2idx = i + (z2->base - z1->base);
618
        z->frames[z2idx] = z2->frames[i];
619
    }
1093 palkovsky 620
    i = 0;
621
    while (i < z->count) {
622
        if (z->frames[i].refcount) {
623
            /* skip busy frames */
624
            i += 1 << z->frames[i].buddy_order;
625
        } else { /* Free frames, set refcount=1 */
626
            /* All free frames have refcount=0, we need not
627
             * to check the order */
822 palkovsky 628
            z->frames[i].refcount = 1;
629
            z->frames[i].buddy_order = 0;
1093 palkovsky 630
            i++;
822 palkovsky 631
        }
632
    }
633
    /* Add free blocks from the 2 original zones */
634
    while (zone_can_alloc(z1, 0)) {
635
        frame_idx = zone_frame_alloc(z1, 0);
636
        frame = &z->frames[frame_idx];
637
        frame->refcount = 0;
638
        buddy_system_free(z->buddy_system, &frame->buddy_link);
639
    }
640
    while (zone_can_alloc(z2, 0)) {
641
        frame_idx = zone_frame_alloc(z2, 0);
2133 jermar 642
        frame = &z->frames[frame_idx + (z2->base - z1->base)];
822 palkovsky 643
        frame->refcount = 0;
644
        buddy_system_free(z->buddy_system, &frame->buddy_link);
645
    }
646
}
647
 
3191 svoboda 648
/** Return old configuration frames into the zone.
822 palkovsky 649
 *
650
 * We have several cases
651
 * - the conf. data is outside of zone -> exit, shall we call frame_free??
824 palkovsky 652
 * - the conf. data was created by zone_create or
653
 *   updated with reduce_region -> free every frame
654
 *
3191 svoboda 655
 * @param newzone   The actual zone where freeing should occur.
656
 * @param oldzone   Pointer to old zone configuration data that should
657
 *          be freed from new zone.
822 palkovsky 658
 */
659
static void return_config_frames(zone_t *newzone, zone_t *oldzone)
660
{
661
    pfn_t pfn;
662
    frame_t *frame;
663
    count_t cframes;
2122 decky 664
    unsigned int i;
822 palkovsky 665
 
1780 jermar 666
    pfn = ADDR2PFN((uintptr_t)KA2PA(oldzone));
822 palkovsky 667
    cframes = SIZE2FRAMES(zone_conf_size(oldzone->count));
668
 
669
    if (pfn < newzone->base || pfn >= newzone->base + newzone->count)
670
        return;
671
 
672
    frame = &newzone->frames[pfn - newzone->base];
824 palkovsky 673
    ASSERT(!frame->buddy_order);
822 palkovsky 674
 
2122 decky 675
    for (i = 0; i < cframes; i++) {
822 palkovsky 676
        newzone->busy_count++;
677
        zone_frame_free(newzone, pfn+i-newzone->base);
678
    }
679
}
680
 
3191 svoboda 681
/** Reduce allocated block to count of order 0 frames.
824 palkovsky 682
 *
683
 * The allocated block need 2^order frames of space. Reduce all frames
1568 palkovsky 684
 * in block to order 0 and free the unneeded frames. This means, that
685
 * when freeing the previously allocated block starting with frame_idx,
686
 * you have to free every frame.
824 palkovsky 687
 *
688
 * @param zone
3191 svoboda 689
 * @param frame_idx     Index to block.
690
 * @param count         Allocated space in block.
824 palkovsky 691
 */
692
static void zone_reduce_region(zone_t *zone, pfn_t frame_idx, count_t count)
693
{
694
    count_t i;
1780 jermar 695
    uint8_t order;
824 palkovsky 696
    frame_t *frame;
697
 
2122 decky 698
    ASSERT(frame_idx + count < zone->count);
824 palkovsky 699
 
700
    order = zone->frames[frame_idx].buddy_order;
2122 decky 701
    ASSERT((count_t) (1 << order) >= count);
824 palkovsky 702
 
703
    /* Reduce all blocks to order 0 */
2122 decky 704
    for (i = 0; i < (count_t) (1 << order); i++) {
824 palkovsky 705
        frame = &zone->frames[i + frame_idx];
706
        frame->buddy_order = 0;
2133 jermar 707
        if (!frame->refcount)
824 palkovsky 708
            frame->refcount = 1;
709
        ASSERT(frame->refcount == 1);
710
    }
711
    /* Free unneeded frames */
2122 decky 712
    for (i = count; i < (count_t) (1 << order); i++) {
824 palkovsky 713
        zone_frame_free(zone, i + frame_idx);
714
    }
715
}
716
 
3191 svoboda 717
/** Merge zones z1 and z2.
822 palkovsky 718
 *
719
 * - the zones must be 2 zones with no zone existing in between,
720
 *   which means that z2 = z1+1
721
 *
722
 * - When you create a new zone, the frame allocator configuration does
723
 *   not to be 2^order size. Once the allocator is running it is no longer
724
 *   possible, merged configuration data occupies more space :-/
725
 */
2122 decky 726
void zone_merge(unsigned int z1, unsigned int z2)
822 palkovsky 727
{
728
    ipl_t ipl;
729
    zone_t *zone1, *zone2, *newzone;
2122 decky 730
    unsigned int cframes;
1780 jermar 731
    uint8_t order;
2122 decky 732
    unsigned int i;
822 palkovsky 733
    pfn_t pfn;
734
 
735
    ipl = interrupts_disable();
736
    spinlock_lock(&zones.lock);
737
 
2745 decky 738
    if ((z1 >= zones.count) || (z2 >= zones.count))
822 palkovsky 739
        goto errout;
740
    /* We can join only 2 zones with none existing inbetween */
3191 svoboda 741
    if (z2 - z1 != 1)
822 palkovsky 742
        goto errout;
743
 
744
    zone1 = zones.info[z1];
745
    zone2 = zones.info[z2];
746
    spinlock_lock(&zone1->lock);
747
    spinlock_lock(&zone2->lock);
748
 
2133 jermar 749
    cframes = SIZE2FRAMES(zone_conf_size(zone2->base + zone2->count -
750
        zone1->base));
1700 palkovsky 751
    if (cframes == 1)
752
        order = 0;
753
    else
754
        order = fnzb(cframes - 1) + 1;
822 palkovsky 755
 
756
    /* Allocate zonedata inside one of the zones */
757
    if (zone_can_alloc(zone1, order))
758
        pfn = zone1->base + zone_frame_alloc(zone1, order);
759
    else if (zone_can_alloc(zone2, order))
760
        pfn = zone2->base + zone_frame_alloc(zone2, order);
761
    else
762
        goto errout2;
763
 
2122 decky 764
    newzone = (zone_t *) PA2KA(PFN2ADDR(pfn));
822 palkovsky 765
 
766
    _zone_merge(newzone, zone1, zone2);
767
 
824 palkovsky 768
    /* Free unneeded config frames */
769
    zone_reduce_region(newzone, pfn - newzone->base,  cframes);
822 palkovsky 770
    /* Subtract zone information from busy frames */
824 palkovsky 771
    newzone->busy_count -= cframes;
822 palkovsky 772
 
824 palkovsky 773
    /* Replace existing zones in zoneinfo list */
822 palkovsky 774
    zones.info[z1] = newzone;
1037 decky 775
    for (i = z2 + 1; i < zones.count; i++)
776
        zones.info[i - 1] = zones.info[i];
822 palkovsky 777
    zones.count--;
778
 
779
    /* Free old zone information */
780
    return_config_frames(newzone, zone1);
781
    return_config_frames(newzone, zone2);
782
errout2:
783
    /* Nobody is allowed to enter to zone, so we are safe
784
     * to touch the spinlocks last time */
785
    spinlock_unlock(&zone1->lock);
786
    spinlock_unlock(&zone2->lock);
787
errout:
788
    spinlock_unlock(&zones.lock);
789
    interrupts_restore(ipl);
790
}
791
 
3191 svoboda 792
/** Merge all zones into one big zone.
822 palkovsky 793
 *
794
 * It is reasonable to do this on systems whose bios reports parts in chunks,
795
 * so that we could have 1 zone (it's faster).
796
 */
797
void zone_merge_all(void)
798
{
799
    int count = zones.count;
800
 
801
    while (zones.count > 1 && --count) {
3191 svoboda 802
        zone_merge(0, 1);
822 palkovsky 803
        break;
804
    }
805
}
806
 
3191 svoboda 807
/** Create new frame zone.
814 palkovsky 808
 *
3191 svoboda 809
 * @param start     Physical address of the first frame within the zone.
810
 * @param count     Count of frames in zone.
811
 * @param z     Address of configuration information of zone.
812
 * @param flags     Zone flags.
814 palkovsky 813
 *
3191 svoboda 814
 * @return      Initialized zone.
814 palkovsky 815
 */
822 palkovsky 816
static void zone_construct(pfn_t start, count_t count, zone_t *z, int flags)
814 palkovsky 817
{
2122 decky 818
    unsigned int i;
1780 jermar 819
    uint8_t max_order;
814 palkovsky 820
 
821
    spinlock_initialize(&z->lock, "zone_lock");
822
    z->base = start;
823
    z->count = count;
3211 svoboda 824
 
825
    /* Mask off flags that are calculated automatically. */
826
    flags &= ~FRAME_LOW_4_GiB;
827
    /* Determine calculated flags. */
828
    if (z->base + count < (1ULL << (32 - FRAME_WIDTH))) /* 4 GiB */
829
        flags |= FRAME_LOW_4_GiB;
830
 
814 palkovsky 831
    z->flags = flags;
3211 svoboda 832
 
814 palkovsky 833
    z->free_count = count;
834
    z->busy_count = 0;
835
 
836
    /*
837
     * Compute order for buddy system, initialize
838
     */
822 palkovsky 839
    max_order = fnzb(count);
814 palkovsky 840
    z->buddy_system = (buddy_system_t *)&z[1];
841
 
842
    buddy_system_create(z->buddy_system, max_order,
3191 svoboda 843
        &zone_buddy_system_operations, (void *) z);
814 palkovsky 844
 
845
    /* Allocate frames _after_ the conframe */
846
    /* Check sizes */
2133 jermar 847
    z->frames = (frame_t *)((uint8_t *) z->buddy_system +
848
        buddy_conf_size(max_order));
2122 decky 849
    for (i = 0; i < count; i++) {
814 palkovsky 850
        frame_initialize(&z->frames[i]);
851
    }
852 palkovsky 852
 
814 palkovsky 853
    /* Stuffing frames */
854
    for (i = 0; i < count; i++) {
855
        z->frames[i].refcount = 0;
856
        buddy_system_free(z->buddy_system, &z->frames[i].buddy_link);
857
    }
858
}
859
 
3191 svoboda 860
/** Compute configuration data size for zone.
1568 palkovsky 861
 *
3191 svoboda 862
 * @param count     Size of zone in frames.
863
 * @return      Size of zone configuration info (in bytes).
1568 palkovsky 864
 */
1780 jermar 865
uintptr_t zone_conf_size(count_t count)
814 palkovsky 866
{
3149 svoboda 867
    int size = sizeof(zone_t) + count * sizeof(frame_t);
814 palkovsky 868
    int max_order;
869
 
822 palkovsky 870
    max_order = fnzb(count);
814 palkovsky 871
    size += buddy_conf_size(max_order);
872
    return size;
873
}
874
 
3191 svoboda 875
/** Create and add zone to system.
814 palkovsky 876
 *
3191 svoboda 877
 * @param start     First frame number (absolute).
878
 * @param count     Size of zone in frames.
879
 * @param confframe Where configuration frames are supposed to be.
880
 *          Automatically checks, that we will not disturb the
881
 *          kernel and possibly init.  If confframe is given
882
 *          _outside_ this zone, it is expected, that the area is
883
 *          already marked BUSY and big enough to contain
884
 *          zone_conf_size() amount of data.  If the confframe is
885
 *          inside the area, the zone free frame information is
886
 *          modified not to include it.
822 palkovsky 887
 *
3191 svoboda 888
 * @return      Zone number or -1 on error.
814 palkovsky 889
 */
822 palkovsky 890
int zone_create(pfn_t start, count_t count, pfn_t confframe, int flags)
814 palkovsky 891
{
892
    zone_t *z;
1780 jermar 893
    uintptr_t addr;
820 jermar 894
    count_t confcount;
2122 decky 895
    unsigned int i;
822 palkovsky 896
    int znum;
814 palkovsky 897
 
898
    /* Theoretically we could have here 0, practically make sure
899
     * nobody tries to do that. If some platform requires, remove
900
     * the assert
901
     */
902
    ASSERT(confframe);
903
    /* If conframe is supposed to be inside our zone, then make sure
904
     * it does not span kernel & init
905
     */
822 palkovsky 906
    confcount = SIZE2FRAMES(zone_conf_size(count));
3191 svoboda 907
    if (confframe >= start && confframe < start + count) {
908
        for (; confframe < start + count; confframe++) {
814 palkovsky 909
            addr = PFN2ADDR(confframe);
2133 jermar 910
            if (overlaps(addr, PFN2ADDR(confcount),
911
                KA2PA(config.base), config.kernel_size))
814 palkovsky 912
                continue;
1037 decky 913
 
2133 jermar 914
            if (overlaps(addr, PFN2ADDR(confcount),
915
                KA2PA(config.stack_base), config.stack_size))
1833 decky 916
                continue;
917
 
1037 decky 918
            bool overlap = false;
919
            count_t i;
920
            for (i = 0; i < init.cnt; i++)
2133 jermar 921
                if (overlaps(addr, PFN2ADDR(confcount),
922
                    KA2PA(init.tasks[i].addr),
923
                    init.tasks[i].size)) {
1037 decky 924
                    overlap = true;
925
                    break;
926
                }
927
            if (overlap)
928
                continue;
929
 
814 palkovsky 930
            break;
931
        }
1037 decky 932
        if (confframe >= start + count)
814 palkovsky 933
            panic("Cannot find configuration data for zone.");
934
    }
935
 
2725 decky 936
    z = (zone_t *) PA2KA(PFN2ADDR(confframe));
822 palkovsky 937
    zone_construct(start, count, z, flags);
938
    znum = zones_add_zone(z);
939
    if (znum == -1)
940
        return -1;
941
 
3191 svoboda 942
    mutex_lock(&mem_avail_mtx);
943
    mem_avail_frames += count;
944
    mutex_unlock(&mem_avail_mtx);
945
 
814 palkovsky 946
    /* If confdata in zone, mark as unavailable */
2122 decky 947
    if (confframe >= start && confframe < start + count)
948
        for (i = confframe; i < confframe + confcount; i++) {
814 palkovsky 949
            zone_mark_unavailable(z, i - z->base);
950
        }
3191 svoboda 951
 
822 palkovsky 952
    return znum;
814 palkovsky 953
}
954
 
955
/***************************************/
956
/* Frame functions */
957
 
3191 svoboda 958
/** Set parent of frame. */
2122 decky 959
void frame_set_parent(pfn_t pfn, void *data, unsigned int hint)
814 palkovsky 960
{
961
    zone_t *zone = find_zone_and_lock(pfn, &hint);
962
 
963
    ASSERT(zone);
964
 
3191 svoboda 965
    zone_get_frame(zone, pfn - zone->base)->parent = data;
814 palkovsky 966
    spinlock_unlock(&zone->lock);
967
}
968
 
2133 jermar 969
void *frame_get_parent(pfn_t pfn, unsigned int hint)
814 palkovsky 970
{
971
    zone_t *zone = find_zone_and_lock(pfn, &hint);
972
    void *res;
973
 
974
    ASSERT(zone);
975
    res = zone_get_frame(zone, pfn - zone->base)->parent;
976
 
977
    spinlock_unlock(&zone->lock);
978
    return res;
979
}
980
 
981
/** Allocate power-of-two frames of physical memory.
982
 *
3191 svoboda 983
 * @param order     Allocate exactly 2^order frames.
984
 * @param flags     Flags for host zone selection and address processing.
985
 * @param pzone     Preferred zone.
814 palkovsky 986
 *
3191 svoboda 987
 * @return      Physical address of the allocated frame.
1269 decky 988
 *
814 palkovsky 989
 */
3191 svoboda 990
void *frame_alloc_generic(uint8_t order, int flags, unsigned int *pzone)
814 palkovsky 991
{
992
    ipl_t ipl;
993
    int freed;
994
    pfn_t v;
995
    zone_t *zone;
3191 svoboda 996
    unsigned long gen = 0;
814 palkovsky 997
 
998
loop:
999
    ipl = interrupts_disable();
1269 decky 1000
 
814 palkovsky 1001
    /*
1002
     * First, find suitable frame zone.
1003
     */
3211 svoboda 1004
    zone = find_free_zone_and_lock(order, flags, pzone);
1269 decky 1005
 
814 palkovsky 1006
    /* If no memory, reclaim some slab memory,
1007
       if it does not help, reclaim all */
1008
    if (!zone && !(flags & FRAME_NO_RECLAIM)) {
1009
        freed = slab_reclaim(0);
1010
        if (freed)
3211 svoboda 1011
            zone = find_free_zone_and_lock(order, flags, pzone);
814 palkovsky 1012
        if (!zone) {
1013
            freed = slab_reclaim(SLAB_RECLAIM_ALL);
1014
            if (freed)
3211 svoboda 1015
                zone = find_free_zone_and_lock(order, flags,
1016
                    pzone);
814 palkovsky 1017
        }
1018
    }
1019
    if (!zone) {
1020
        /*
3191 svoboda 1021
         * Sleep until some frames are available again.
814 palkovsky 1022
         */
3191 svoboda 1023
        if (flags & FRAME_ATOMIC) {
1024
            interrupts_restore(ipl);
1760 palkovsky 1025
            return 0;
3191 svoboda 1026
        }
814 palkovsky 1027
 
3191 svoboda 1028
#ifdef CONFIG_DEBUG
1029
        unsigned long avail;
1030
 
1031
        mutex_lock(&mem_avail_mtx);
1032
        avail = mem_avail_frames;
1033
        mutex_unlock(&mem_avail_mtx);
1034
 
1035
        printf("Thread %" PRIu64 " waiting for %u frames, "
1036
            "%u available.\n", THREAD->tid, 1ULL << order, avail);
1037
#endif
1038
 
1039
        mutex_lock(&mem_avail_mtx);
1040
        while ((mem_avail_frames < (1ULL << order)) ||
1041
            gen == mem_avail_gen)
1042
            condvar_wait(&mem_avail_cv, &mem_avail_mtx);
1043
        gen = mem_avail_gen;
1044
        mutex_unlock(&mem_avail_mtx);
1045
 
1046
#ifdef CONFIG_DEBUG
1047
        mutex_lock(&mem_avail_mtx);
1048
        avail = mem_avail_frames;
1049
        mutex_unlock(&mem_avail_mtx);
1050
 
1051
        printf("Thread %" PRIu64 " woken up, %u frames available.\n",
1052
            THREAD->tid, avail);
1053
#endif
1054
 
1055
        interrupts_restore(ipl);
814 palkovsky 1056
        goto loop;
1057
    }
1269 decky 1058
 
1059
    v = zone_frame_alloc(zone, order);
814 palkovsky 1060
    v += zone->base;
1061
 
1062
    spinlock_unlock(&zone->lock);
3191 svoboda 1063
 
1064
    mutex_lock(&mem_avail_mtx);
1065
    mem_avail_frames -= (1ULL << order);
1066
    mutex_unlock(&mem_avail_mtx);
1067
 
814 palkovsky 1068
    interrupts_restore(ipl);
1069
 
1760 palkovsky 1070
    if (flags & FRAME_KA)
1071
        return (void *)PA2KA(PFN2ADDR(v));
1072
    return (void *)PFN2ADDR(v);
814 palkovsky 1073
}
1074
 
1075
/** Free a frame.
1076
 *
1854 jermar 1077
 * Find respective frame structure for supplied physical frame address.
814 palkovsky 1078
 * Decrement frame reference count.
1079
 * If it drops to zero, move the frame structure to free list.
1080
 *
3191 svoboda 1081
 * @param frame     Physical Address of of the frame to be freed.
814 palkovsky 1082
 */
1780 jermar 1083
void frame_free(uintptr_t frame)
814 palkovsky 1084
{
1085
    ipl_t ipl;
1086
    zone_t *zone;
1760 palkovsky 1087
    pfn_t pfn = ADDR2PFN(frame);
814 palkovsky 1088
 
1089
    ipl = interrupts_disable();
3191 svoboda 1090
 
814 palkovsky 1091
    /*
1092
     * First, find host frame zone for addr.
1093
     */
3191 svoboda 1094
    zone = find_zone_and_lock(pfn, NULL);
814 palkovsky 1095
    ASSERT(zone);
1096
 
3191 svoboda 1097
    zone_frame_free(zone, pfn - zone->base);
814 palkovsky 1098
 
1099
    spinlock_unlock(&zone->lock);
3191 svoboda 1100
 
1101
    /*
1102
     * Signal that some memory has been freed.
1103
     */
1104
    mutex_lock(&mem_avail_mtx);
1105
    mem_avail_frames++;
1106
    mem_avail_gen++;
1107
    condvar_broadcast(&mem_avail_cv);
1108
    mutex_unlock(&mem_avail_mtx);
1109
 
814 palkovsky 1110
    interrupts_restore(ipl);
1111
}
1112
 
1236 jermar 1113
/** Add reference to frame.
1114
 *
1115
 * Find respective frame structure for supplied PFN and
1116
 * increment frame reference count.
1117
 *
3191 svoboda 1118
 * @param pfn       Frame number of the frame to be freed.
1236 jermar 1119
 */
1120
void frame_reference_add(pfn_t pfn)
1121
{
1122
    ipl_t ipl;
1123
    zone_t *zone;
1124
    frame_t *frame;
814 palkovsky 1125
 
1236 jermar 1126
    ipl = interrupts_disable();
1127
 
1128
    /*
1129
     * First, find host frame zone for addr.
1130
     */
3191 svoboda 1131
    zone = find_zone_and_lock(pfn, NULL);
1236 jermar 1132
    ASSERT(zone);
1133
 
3191 svoboda 1134
    frame = &zone->frames[pfn - zone->base];
1236 jermar 1135
    frame->refcount++;
1136
 
1137
    spinlock_unlock(&zone->lock);
1138
    interrupts_restore(ipl);
1139
}
814 palkovsky 1140
 
3191 svoboda 1141
/** Mark given range unavailable in frame zones. */
820 jermar 1142
void frame_mark_unavailable(pfn_t start, count_t count)
814 palkovsky 1143
{
2122 decky 1144
    unsigned int i;
814 palkovsky 1145
    zone_t *zone;
2122 decky 1146
    unsigned int prefzone = 0;
852 palkovsky 1147
 
2122 decky 1148
    for (i = 0; i < count; i++) {
1981 jermar 1149
        zone = find_zone_and_lock(start + i, &prefzone);
814 palkovsky 1150
        if (!zone) /* PFN not found */
1151
            continue;
1981 jermar 1152
        zone_mark_unavailable(zone, start + i - zone->base);
814 palkovsky 1153
 
1154
        spinlock_unlock(&zone->lock);
1155
    }
1156
}
1157
 
3191 svoboda 1158
/** Initialize physical memory management. */
814 palkovsky 1159
void frame_init(void)
1160
{
1161
    if (config.cpu_active == 1) {
1162
        zones.count = 0;
1981 jermar 1163
        spinlock_initialize(&zones.lock, "zones.lock");
3191 svoboda 1164
        mutex_initialize(&mem_avail_mtx, MUTEX_ACTIVE);
1165
        condvar_initialize(&mem_avail_cv);
814 palkovsky 1166
    }
1167
    /* Tell the architecture to create some memory */
1168
    frame_arch_init();
1169
    if (config.cpu_active == 1) {
2133 jermar 1170
        frame_mark_unavailable(ADDR2PFN(KA2PA(config.base)),
1171
            SIZE2FRAMES(config.kernel_size));
1172
        frame_mark_unavailable(ADDR2PFN(KA2PA(config.stack_base)),
1173
            SIZE2FRAMES(config.stack_size));
1037 decky 1174
 
1175
        count_t i;
2133 jermar 1176
        for (i = 0; i < init.cnt; i++) {
1177
            pfn_t pfn = ADDR2PFN(KA2PA(init.tasks[i].addr));
1178
            frame_mark_unavailable(pfn,
1179
                SIZE2FRAMES(init.tasks[i].size));
1180
        }
1599 palkovsky 1181
 
1894 jermar 1182
        if (ballocs.size)
2133 jermar 1183
            frame_mark_unavailable(ADDR2PFN(KA2PA(ballocs.base)),
1184
                SIZE2FRAMES(ballocs.size));
1894 jermar 1185
 
1599 palkovsky 1186
        /* Black list first frame, as allocating NULL would
1790 jermar 1187
         * fail in some places */
1599 palkovsky 1188
        frame_mark_unavailable(0, 1);
814 palkovsky 1189
    }
1190
}
1191
 
1192
 
3191 svoboda 1193
/** Return total size of all zones. */
1194
uint64_t zone_total_size(void)
1195
{
2725 decky 1196
    zone_t *zone = NULL;
1197
    unsigned int i;
1198
    ipl_t ipl;
1199
    uint64_t total = 0;
814 palkovsky 1200
 
2725 decky 1201
    ipl = interrupts_disable();
1202
    spinlock_lock(&zones.lock);
1203
 
1204
    for (i = 0; i < zones.count; i++) {
1205
        zone = zones.info[i];
1206
        spinlock_lock(&zone->lock);
1207
        total += (uint64_t) FRAMES2SIZE(zone->count);
1208
        spinlock_unlock(&zone->lock);
1209
    }
1210
 
1211
    spinlock_unlock(&zones.lock);
1212
    interrupts_restore(ipl);
1213
 
1214
    return total;
1215
}
1216
 
3191 svoboda 1217
/** Prints list of zones. */
1218
void zone_print_list(void)
1219
{
676 bondari 1220
    zone_t *zone = NULL;
2122 decky 1221
    unsigned int i;
701 jermar 1222
    ipl_t ipl;
1223
 
3149 svoboda 1224
#ifdef __32_BITS__  
1225
    printf("#  base address free frames  busy frames\n");
1226
    printf("-- ------------ ------------ ------------\n");
1227
#endif
1228
 
1229
#ifdef __64_BITS__
1230
    printf("#  base address         free frames  busy frames\n");
1231
    printf("-- -------------------- ------------ ------------\n");
1232
#endif
2712 decky 1233
 
3211 svoboda 1234
    /*
1235
     * Because printing may require allocation of memory, we may not hold
1236
     * the frame allocator locks when printing zone statistics.  Therefore,
1237
     * we simply gather the statistics under the protection of the locks and
1238
     * print the statistics when the locks have been released.
1239
     *
1240
     * When someone adds/removes zones while we are printing the statistics,
1241
     * we may end up with inaccurate output (e.g. a zone being skipped from
1242
     * the listing).
1243
     */
1244
 
1245
    for (i = 0; ; i++) {
1246
        uintptr_t base;
1247
        count_t free_count;
1248
        count_t busy_count;
1249
 
1250
        ipl = interrupts_disable();
1251
        spinlock_lock(&zones.lock);
1252
 
1253
        if (i >= zones.count) {
1254
            spinlock_unlock(&zones.lock);
1255
            interrupts_restore(ipl);
1256
            break;
1257
        }
1258
 
814 palkovsky 1259
        zone = zones.info[i];
683 bondari 1260
        spinlock_lock(&zone->lock);
3149 svoboda 1261
 
3211 svoboda 1262
        base = PFN2ADDR(zone->base);
1263
        free_count = zone->free_count;
1264
        busy_count = zone->busy_count;
1265
 
1266
        spinlock_unlock(&zone->lock);
1267
 
1268
        spinlock_unlock(&zones.lock);
1269
        interrupts_restore(ipl);
1270
 
3149 svoboda 1271
#ifdef __32_BITS__
3211 svoboda 1272
        printf("%-2u   %10p %12" PRIc " %12" PRIc "\n", i, base,
1273
            free_count, busy_count);
3149 svoboda 1274
#endif
1275
 
1276
#ifdef __64_BITS__
3211 svoboda 1277
        printf("%-2u   %18p %12" PRIc " %12" PRIc "\n", i, base,
1278
            free_count, busy_count);
3149 svoboda 1279
#endif
2712 decky 1280
 
676 bondari 1281
    }
1282
}
1283
 
1708 jermar 1284
/** Prints zone details.
677 bondari 1285
 *
3191 svoboda 1286
 * @param num       Zone base address or zone number.
677 bondari 1287
 */
3191 svoboda 1288
void zone_print_one(unsigned int num)
1289
{
814 palkovsky 1290
    zone_t *zone = NULL;
701 jermar 1291
    ipl_t ipl;
2122 decky 1292
    unsigned int i;
3211 svoboda 1293
    uintptr_t base;
1294
    count_t count;
1295
    count_t busy_count;
1296
    count_t free_count;
701 jermar 1297
 
1298
    ipl = interrupts_disable();
814 palkovsky 1299
    spinlock_lock(&zones.lock);
822 palkovsky 1300
 
1037 decky 1301
    for (i = 0; i < zones.count; i++) {
2725 decky 1302
        if ((i == num) || (PFN2ADDR(zones.info[i]->base) == num)) {
822 palkovsky 1303
            zone = zones.info[i];
1304
            break;
1305
        }
676 bondari 1306
    }
822 palkovsky 1307
    if (!zone) {
3211 svoboda 1308
        spinlock_unlock(&zones.lock);
1309
        interrupts_restore(ipl);
822 palkovsky 1310
        printf("Zone not found.\n");
3211 svoboda 1311
        return;
822 palkovsky 1312
    }
676 bondari 1313
 
683 bondari 1314
    spinlock_lock(&zone->lock);
3211 svoboda 1315
    base = PFN2ADDR(zone->base);
1316
    count = zone->count;
1317
    busy_count = zone->busy_count;
1318
    free_count = zone->free_count;
2725 decky 1319
    spinlock_unlock(&zone->lock);
814 palkovsky 1320
    spinlock_unlock(&zones.lock);
701 jermar 1321
    interrupts_restore(ipl);
3211 svoboda 1322
 
1323
    printf("Zone base address: %p\n", base);
1324
    printf("Zone size: %" PRIc " frames (%" PRIs " KiB)\n", count,
1325
        SIZE2KB(FRAMES2SIZE(count)));
1326
    printf("Allocated space: %" PRIc " frames (%" PRIs " KiB)\n",
1327
        busy_count, SIZE2KB(FRAMES2SIZE(busy_count)));
1328
    printf("Available space: %" PRIc " frames (%" PRIs " KiB)\n",
1329
        free_count, SIZE2KB(FRAMES2SIZE(free_count)));
676 bondari 1330
}
1331
 
1757 jermar 1332
/** @}
1702 cejka 1333
 */
2133 jermar 1334