Subversion Repositories HelenOS

Rev

Rev 3386 | Details | Compare with Previous | Last modification | View Log | RSS feed

Rev Author Line No. Line
1200 jermar 1
/*
2071 jermar 2
 * Copyright (c) 2006 Jakub Jermar
1200 jermar 3
 * All rights reserved.
4
 *
5
 * Redistribution and use in source and binary forms, with or without
6
 * modification, are permitted provided that the following conditions
7
 * are met:
8
 *
9
 * - Redistributions of source code must retain the above copyright
10
 *   notice, this list of conditions and the following disclaimer.
11
 * - Redistributions in binary form must reproduce the above copyright
12
 *   notice, this list of conditions and the following disclaimer in the
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
15
 *   derived from this software without specific prior written permission.
16
 *
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
19
 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
20
 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
21
 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
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
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
26
 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
27
 */
28
 
1757 jermar 29
/** @addtogroup genericadt
1702 cejka 30
 * @{
31
 */
1248 jermar 32
/**
1704 cejka 33
 * @file
1248 jermar 34
 * @brief   Implementation of bitmap ADT.
35
 *
36
 * This file implements bitmap ADT and provides functions for
37
 * setting and clearing ranges of bits.
38
 */
39
 
1200 jermar 40
#include <adt/bitmap.h>
41
#include <arch/types.h>
42
#include <align.h>
43
#include <debug.h>
1262 jermar 44
#include <macros.h>
1200 jermar 45
 
46
#define ALL_ONES    0xff
47
#define ALL_ZEROES  0x00
48
 
49
/** Initialize bitmap.
50
 *
51
 * No portion of the bitmap is set or cleared by this function.
52
 *
53
 * @param bitmap Bitmap structure.
54
 * @param map Address of the memory used to hold the map.
55
 * @param bits Number of bits stored in bitmap.
56
 */
4581 mejdrech 57
void bitmap_initialize(bitmap_t *bitmap, uint8_t *map, size_t bits)
1200 jermar 58
{
59
    bitmap->map = map;
60
    bitmap->bits = bits;
61
}
62
 
63
/** Set range of bits.
64
 *
65
 * @param bitmap Bitmap structure.
66
 * @param start Starting bit.
67
 * @param bits Number of bits to set.
68
 */
4581 mejdrech 69
void bitmap_set_range(bitmap_t *bitmap, size_t start, size_t bits)
1200 jermar 70
{
4581 mejdrech 71
    size_t i = 0;
72
    size_t aligned_start;
73
    size_t lub;     /* leading unaligned bits */
74
    size_t amb;     /* aligned middle bits */
75
    size_t tab;     /* trailing aligned bits */
1200 jermar 76
 
77
    ASSERT(start + bits <= bitmap->bits);
78
 
79
    aligned_start = ALIGN_UP(start, 8);
1262 jermar 80
    lub = min(aligned_start - start, bits);
81
    amb = bits > lub ? bits - lub : 0;
82
    tab = amb % 8;
1200 jermar 83
 
1549 vana 84
    if ( start + bits < aligned_start ) {
85
        /*
86
        * Set bits in the middle of byte
87
        */
88
        bitmap->map[start / 8] |= ((1 << lub)-1) << (start&7);
89
        return;
90
    }
91
 
1200 jermar 92
    if (lub) {
93
        /*
94
         * Make sure to set any leading unaligned bits.
95
         */
96
        bitmap->map[start / 8] |= ~((1 << (8 - lub)) - 1);
97
    }
1262 jermar 98
    for (i = 0; i < amb / 8; i++) {
1200 jermar 99
        /*
100
         * The middle bits can be set byte by byte.
101
         */
102
        bitmap->map[aligned_start / 8 + i] = ALL_ONES;
103
    }
1262 jermar 104
    if (tab) {
1200 jermar 105
        /*
1262 jermar 106
         * Make sure to set any trailing aligned bits.
1200 jermar 107
         */
1262 jermar 108
        bitmap->map[aligned_start / 8 + i] |= (1 << tab) - 1;
1200 jermar 109
    }
110
 
111
}
112
 
113
/** Clear range of bits.
114
 *
115
 * @param bitmap Bitmap structure.
116
 * @param start Starting bit.
117
 * @param bits Number of bits to clear.
118
 */
4581 mejdrech 119
void bitmap_clear_range(bitmap_t *bitmap, size_t start, size_t bits)
1200 jermar 120
{
4581 mejdrech 121
    size_t i = 0;
122
    size_t aligned_start;
123
    size_t lub;     /* leading unaligned bits */
124
    size_t amb;     /* aligned middle bits */
125
    size_t tab;     /* trailing aligned bits */
1200 jermar 126
 
127
    ASSERT(start + bits <= bitmap->bits);
128
 
129
    aligned_start = ALIGN_UP(start, 8);
1262 jermar 130
    lub = min(aligned_start - start, bits);
131
    amb = bits > lub ? bits - lub : 0;
132
    tab = amb % 8;
133
 
1549 vana 134
    if ( start + bits < aligned_start )
135
    {
136
        /*
137
        * Set bits in the middle of byte
138
        */
139
        bitmap->map[start / 8] &= ~(((1 << lub)-1) << (start&7));
140
        return;
141
    }
142
 
143
 
1200 jermar 144
    if (lub) {
145
        /*
146
         * Make sure to clear any leading unaligned bits.
147
         */
148
        bitmap->map[start / 8] &= (1 << (8 - lub)) - 1;
149
    }
1262 jermar 150
    for (i = 0; i < amb / 8; i++) {
1200 jermar 151
        /*
152
         * The middle bits can be cleared byte by byte.
153
         */
154
        bitmap->map[aligned_start / 8 + i] = ALL_ZEROES;
155
    }
1262 jermar 156
    if (tab) {
1200 jermar 157
        /*
1262 jermar 158
         * Make sure to clear any trailing aligned bits.
1200 jermar 159
         */
1262 jermar 160
        bitmap->map[aligned_start / 8 + i] &= ~((1 << tab) - 1);
1200 jermar 161
    }
1262 jermar 162
 
1200 jermar 163
}
164
 
165
/** Copy portion of one bitmap into another bitmap.
166
 *
167
 * @param dst Destination bitmap.
168
 * @param src Source bitmap.
169
 * @param bits Number of bits to copy.
170
 */
4581 mejdrech 171
void bitmap_copy(bitmap_t *dst, bitmap_t *src, size_t bits)
1200 jermar 172
{
4581 mejdrech 173
    size_t i;
1200 jermar 174
 
175
    ASSERT(bits <= dst->bits);
176
    ASSERT(bits <= src->bits);
177
 
178
    for (i = 0; i < bits / 8; i++)
179
        dst->map[i] = src->map[i];
180
 
181
    if (bits % 8) {
182
        bitmap_clear_range(dst, i * 8, bits % 8);
183
        dst->map[i] |= src->map[i] & ((1 << (bits % 8)) - 1);
184
    }
185
}
1702 cejka 186
 
1757 jermar 187
/** @}
1702 cejka 188
 */