Navigation
- Accueil
- Présentation :
- FAQ
- Bugs et errata
- Contributions de lecteurs
- Téléchargements
- LXR (référencement des sources)
- Mailing-list
- Liens et Projets reliés
Site hébergé par :
Site hébergé par :
|
[ source navigation ] [ diff markup ] [ identifier search ] [ general search ] |
|||
|
||||
001 /* Copyright (C) 2004 David Decotigny 001 /* Copyright (C) 2004 David Decotigny 002 002 003 This program is free software; you can redi 003 This program is free software; you can redistribute it and/or 004 modify it under the terms of the GNU Genera 004 modify it under the terms of the GNU General Public License 005 as published by the Free Software Foundatio 005 as published by the Free Software Foundation; either version 2 006 of the License, or (at your option) any lat 006 of the License, or (at your option) any later version. 007 007 008 This program is distributed in the hope tha 008 This program is distributed in the hope that it will be useful, 009 but WITHOUT ANY WARRANTY; without even the 009 but WITHOUT ANY WARRANTY; without even the implied warranty of 010 MERCHANTABILITY or FITNESS FOR A PARTICULAR 010 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 011 GNU General Public License for more details 011 GNU General Public License for more details. 012 012 013 You should have received a copy of the GNU 013 You should have received a copy of the GNU General Public License 014 along with this program; if not, write to t 014 along with this program; if not, write to the Free Software 015 Foundation, Inc., 59 Temple Place - Suite 3 015 Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, 016 USA. 016 USA. 017 */ 017 */ 018 #include <sos/list.h> 018 #include <sos/list.h> 019 #include <sos/macros.h> 019 #include <sos/macros.h> 020 #include <sos/assert.h> 020 #include <sos/assert.h> 021 #include <sos/klibc.h> 021 #include <sos/klibc.h> 022 022 023 #include "physmem.h" 023 #include "physmem.h" 024 024 025 /** A descriptor for a physical page in SOS */ 025 /** A descriptor for a physical page in SOS */ 026 struct physical_page_descr 026 struct physical_page_descr 027 { 027 { 028 /** The physical base address for the page * 028 /** The physical base address for the page */ 029 sos_paddr_t paddr; 029 sos_paddr_t paddr; 030 030 031 /** The reference count for this physical pa 031 /** The reference count for this physical page. > 0 means that the 032 page is in the used list. */ 032 page is in the used list. */ 033 sos_count_t ref_cnt; 033 sos_count_t ref_cnt; 034 034 035 /** Some data associated with the page when 035 /** Some data associated with the page when it is mapped in kernel space */ 036 struct sos_kmem_range *kernel_range; 036 struct sos_kmem_range *kernel_range; 037 037 038 /** The other pages on the list (used, free) 038 /** The other pages on the list (used, free) */ 039 struct physical_page_descr *prev, *next; 039 struct physical_page_descr *prev, *next; 040 }; 040 }; 041 041 042 /** These are some markers present in the exec 042 /** These are some markers present in the executable file (see sos.lds) */ 043 extern char __b_kernel, __e_kernel; 043 extern char __b_kernel, __e_kernel; 044 044 045 /** The array of ppage descriptors will be loc 045 /** The array of ppage descriptors will be located at this address */ 046 #define PAGE_DESCR_ARRAY_ADDR \ 046 #define PAGE_DESCR_ARRAY_ADDR \ 047 SOS_PAGE_ALIGN_SUP((sos_paddr_t) (& __e_kern 047 SOS_PAGE_ALIGN_SUP((sos_paddr_t) (& __e_kernel)) 048 static struct physical_page_descr * physical_p 048 static struct physical_page_descr * physical_page_descr_array; 049 049 050 /** The list of physical pages currently avail 050 /** The list of physical pages currently available */ 051 static struct physical_page_descr *free_ppage; 051 static struct physical_page_descr *free_ppage; 052 052 053 /** The list of physical pages currently in us 053 /** The list of physical pages currently in use */ 054 static struct physical_page_descr *used_ppage; 054 static struct physical_page_descr *used_ppage; 055 055 056 /** We will store here the interval of valid p 056 /** We will store here the interval of valid physical addresses */ 057 static sos_paddr_t physmem_base, physmem_top; 057 static sos_paddr_t physmem_base, physmem_top; 058 058 059 /** We store the number of pages used/free */ 059 /** We store the number of pages used/free */ 060 static sos_count_t physmem_total_pages, physme 060 static sos_count_t physmem_total_pages, physmem_used_pages; 061 061 062 sos_ret_t sos_physmem_setup(sos_size_t ram_siz !! 062 sos_ret_t sos_physmem_subsystem_setup(sos_size_t ram_size, 063 /* out */sos_paddr !! 063 /* out */sos_paddr_t *kernel_core_base, 064 /* out */sos_paddr !! 064 /* out */sos_paddr_t *kernel_core_top) 065 { 065 { 066 /* The iterator over the page descriptors */ 066 /* The iterator over the page descriptors */ 067 struct physical_page_descr *ppage_descr; 067 struct physical_page_descr *ppage_descr; 068 068 069 /* The iterator over the physical addresses 069 /* The iterator over the physical addresses */ 070 sos_paddr_t ppage_addr; 070 sos_paddr_t ppage_addr; 071 071 072 /* Make sure ram size is aligned on a page b 072 /* Make sure ram size is aligned on a page boundary */ 073 ram_size = SOS_PAGE_ALIGN_INF(ram_size);/* Y 073 ram_size = SOS_PAGE_ALIGN_INF(ram_size);/* Yes, we may lose at most a page */ 074 074 075 /* Reset the used/free page lists before bui 075 /* Reset the used/free page lists before building them */ 076 free_ppage = used_ppage = NULL; 076 free_ppage = used_ppage = NULL; 077 physmem_total_pages = physmem_used_pages = 0 077 physmem_total_pages = physmem_used_pages = 0; 078 078 079 /* Make sure that there is enough memory to 079 /* Make sure that there is enough memory to store the array of page 080 descriptors */ 080 descriptors */ 081 *kernel_core_base = SOS_PAGE_ALIGN_INF((sos_ 081 *kernel_core_base = SOS_PAGE_ALIGN_INF((sos_paddr_t)(& __b_kernel)); 082 *kernel_core_top 082 *kernel_core_top 083 = PAGE_DESCR_ARRAY_ADDR 083 = PAGE_DESCR_ARRAY_ADDR 084 + SOS_PAGE_ALIGN_SUP( (ram_size >> SOS_P 084 + SOS_PAGE_ALIGN_SUP( (ram_size >> SOS_PAGE_SHIFT) 085 * sizeof(struct ph 085 * sizeof(struct physical_page_descr)); 086 if (*kernel_core_top > ram_size) 086 if (*kernel_core_top > ram_size) 087 return -SOS_ENOMEM; 087 return -SOS_ENOMEM; 088 088 089 /* Page 0-4kB is not available in order to r 089 /* Page 0-4kB is not available in order to return address 0 as a 090 means to signal "no page available" */ 090 means to signal "no page available" */ 091 physmem_base = SOS_PAGE_SIZE; 091 physmem_base = SOS_PAGE_SIZE; 092 physmem_top = ram_size; 092 physmem_top = ram_size; 093 093 094 /* Setup the page descriptor arrray */ 094 /* Setup the page descriptor arrray */ 095 physical_page_descr_array 095 physical_page_descr_array 096 = (struct physical_page_descr*)PAGE_DESCR_ 096 = (struct physical_page_descr*)PAGE_DESCR_ARRAY_ADDR; 097 097 098 /* Scan the list of physical pages */ 098 /* Scan the list of physical pages */ 099 for (ppage_addr = 0, 099 for (ppage_addr = 0, 100 ppage_descr = physical_page_descr_arr 100 ppage_descr = physical_page_descr_array ; 101 ppage_addr < physmem_top ; 101 ppage_addr < physmem_top ; 102 ppage_addr += SOS_PAGE_SIZE, 102 ppage_addr += SOS_PAGE_SIZE, 103 ppage_descr ++) 103 ppage_descr ++) 104 { 104 { 105 enum { PPAGE_MARK_RESERVED, PPAGE_MARK_F 105 enum { PPAGE_MARK_RESERVED, PPAGE_MARK_FREE, 106 PPAGE_MARK_KERNEL, PPAGE_MARK_HWM 106 PPAGE_MARK_KERNEL, PPAGE_MARK_HWMAP } todo; 107 107 108 memset(ppage_descr, 0x0, sizeof(struct p 108 memset(ppage_descr, 0x0, sizeof(struct physical_page_descr)); 109 109 110 /* Init the page descriptor for this pag 110 /* Init the page descriptor for this page */ 111 ppage_descr->paddr = ppage_addr; 111 ppage_descr->paddr = ppage_addr; 112 112 113 /* Reserved : 0 ... base */ 113 /* Reserved : 0 ... base */ 114 if (ppage_addr < physmem_base) 114 if (ppage_addr < physmem_base) 115 todo = PPAGE_MARK_RESERVED; 115 todo = PPAGE_MARK_RESERVED; 116 116 117 /* Free : base ... BIOS */ 117 /* Free : base ... BIOS */ 118 else if ((ppage_addr >= physmem_base) 118 else if ((ppage_addr >= physmem_base) 119 && (ppage_addr < BIOS_N_VIDEO_S 119 && (ppage_addr < BIOS_N_VIDEO_START)) 120 todo = PPAGE_MARK_FREE; 120 todo = PPAGE_MARK_FREE; 121 121 122 /* Used : BIOS */ 122 /* Used : BIOS */ 123 else if ((ppage_addr >= BIOS_N_VIDEO_STA 123 else if ((ppage_addr >= BIOS_N_VIDEO_START) 124 && (ppage_addr < BIOS_N_VIDEO_E 124 && (ppage_addr < BIOS_N_VIDEO_END)) 125 todo = PPAGE_MARK_HWMAP; 125 todo = PPAGE_MARK_HWMAP; 126 126 127 /* Free : BIOS ... kernel */ 127 /* Free : BIOS ... kernel */ 128 else if ((ppage_addr >= BIOS_N_VIDEO_END 128 else if ((ppage_addr >= BIOS_N_VIDEO_END) 129 && (ppage_addr < (sos_paddr_t) 129 && (ppage_addr < (sos_paddr_t) (& __b_kernel))) 130 todo = PPAGE_MARK_FREE; 130 todo = PPAGE_MARK_FREE; 131 131 132 /* Used : Kernel code/data/bss + physcal 132 /* Used : Kernel code/data/bss + physcal page descr array */ 133 else if ((ppage_addr >= *kernel_core_bas 133 else if ((ppage_addr >= *kernel_core_base) 134 && (ppage_addr < *kernel_core_ 134 && (ppage_addr < *kernel_core_top)) 135 todo = PPAGE_MARK_KERNEL; 135 todo = PPAGE_MARK_KERNEL; 136 136 137 /* Free : first page of descr ... end of 137 /* Free : first page of descr ... end of RAM */ 138 else 138 else 139 todo = PPAGE_MARK_FREE; 139 todo = PPAGE_MARK_FREE; 140 140 141 /* Actually does the insertion in the us 141 /* Actually does the insertion in the used/free page lists */ 142 physmem_total_pages ++; 142 physmem_total_pages ++; 143 switch (todo) 143 switch (todo) 144 { 144 { 145 case PPAGE_MARK_FREE: 145 case PPAGE_MARK_FREE: 146 ppage_descr->ref_cnt = 0; 146 ppage_descr->ref_cnt = 0; 147 list_add_head(free_ppage, ppage_desc 147 list_add_head(free_ppage, ppage_descr); 148 break; 148 break; 149 149 150 case PPAGE_MARK_KERNEL: 150 case PPAGE_MARK_KERNEL: 151 case PPAGE_MARK_HWMAP: 151 case PPAGE_MARK_HWMAP: 152 ppage_descr->ref_cnt = 1; 152 ppage_descr->ref_cnt = 1; 153 list_add_head(used_ppage, ppage_desc 153 list_add_head(used_ppage, ppage_descr); 154 physmem_used_pages ++; 154 physmem_used_pages ++; 155 break; 155 break; 156 156 157 default: 157 default: 158 /* Reserved page: nop */ 158 /* Reserved page: nop */ 159 break; 159 break; 160 } 160 } 161 } 161 } 162 162 163 return SOS_OK; 163 return SOS_OK; 164 } 164 } 165 165 166 166 167 sos_paddr_t sos_physmem_ref_physpage_new(sos_b 167 sos_paddr_t sos_physmem_ref_physpage_new(sos_bool_t can_block) 168 { 168 { 169 struct physical_page_descr *ppage_descr; 169 struct physical_page_descr *ppage_descr; 170 170 171 if (! free_ppage) 171 if (! free_ppage) 172 return (sos_paddr_t)NULL; 172 return (sos_paddr_t)NULL; 173 173 174 /* Retrieve a page in the free list */ 174 /* Retrieve a page in the free list */ 175 ppage_descr = list_pop_head(free_ppage); 175 ppage_descr = list_pop_head(free_ppage); 176 176 177 /* The page is assumed not to be already use 177 /* The page is assumed not to be already used */ 178 SOS_ASSERT_FATAL(ppage_descr->ref_cnt == 0); 178 SOS_ASSERT_FATAL(ppage_descr->ref_cnt == 0); 179 179 180 /* Mark the page as used (this of course set 180 /* Mark the page as used (this of course sets the ref count to 1) */ 181 ppage_descr->ref_cnt ++; 181 ppage_descr->ref_cnt ++; 182 182 183 /* No associated kernel range by default */ 183 /* No associated kernel range by default */ 184 ppage_descr->kernel_range = NULL; 184 ppage_descr->kernel_range = NULL; 185 185 186 /* Put the page in the used list */ 186 /* Put the page in the used list */ 187 list_add_tail(used_ppage, ppage_descr); 187 list_add_tail(used_ppage, ppage_descr); 188 physmem_used_pages ++; 188 physmem_used_pages ++; 189 189 190 return ppage_descr->paddr; 190 return ppage_descr->paddr; 191 } 191 } 192 192 193 193 194 /** 194 /** 195 * Helper function to get the physical page de 195 * Helper function to get the physical page descriptor for the given 196 * physical page address. 196 * physical page address. 197 * 197 * 198 * @return NULL when out-of-bounds or non-page 198 * @return NULL when out-of-bounds or non-page-aligned 199 */ 199 */ 200 inline static struct physical_page_descr * 200 inline static struct physical_page_descr * 201 get_page_descr_at_paddr(sos_paddr_t ppage_padd 201 get_page_descr_at_paddr(sos_paddr_t ppage_paddr) 202 { 202 { 203 /* Don't handle non-page-aligned addresses * 203 /* Don't handle non-page-aligned addresses */ 204 if (ppage_paddr & SOS_PAGE_MASK) 204 if (ppage_paddr & SOS_PAGE_MASK) 205 return NULL; 205 return NULL; 206 206 207 /* Don't support out-of-bounds requests */ 207 /* Don't support out-of-bounds requests */ 208 if ((ppage_paddr < physmem_base) || (ppage_p 208 if ((ppage_paddr < physmem_base) || (ppage_paddr >= physmem_top)) 209 return NULL; 209 return NULL; 210 210 211 return physical_page_descr_array + (ppage_pa 211 return physical_page_descr_array + (ppage_paddr >> SOS_PAGE_SHIFT); 212 } 212 } 213 213 214 214 215 sos_ret_t sos_physmem_ref_physpage_at(sos_padd 215 sos_ret_t sos_physmem_ref_physpage_at(sos_paddr_t ppage_paddr) 216 { 216 { 217 struct physical_page_descr *ppage_descr 217 struct physical_page_descr *ppage_descr 218 = get_page_descr_at_paddr(ppage_paddr); 218 = get_page_descr_at_paddr(ppage_paddr); 219 219 220 if (! ppage_descr) 220 if (! ppage_descr) 221 return -SOS_EINVAL; 221 return -SOS_EINVAL; 222 222 223 /* Increment the reference count for the pag 223 /* Increment the reference count for the page */ 224 ppage_descr->ref_cnt ++; 224 ppage_descr->ref_cnt ++; 225 225 226 /* If the page is newly referenced (ie we ar 226 /* If the page is newly referenced (ie we are the only owners of the 227 page => ref cnt == 1), transfer it in the 227 page => ref cnt == 1), transfer it in the used pages list */ 228 if (ppage_descr->ref_cnt == 1) 228 if (ppage_descr->ref_cnt == 1) 229 { 229 { 230 list_delete(free_ppage, ppage_descr); 230 list_delete(free_ppage, ppage_descr); 231 231 232 /* No associated kernel range by default 232 /* No associated kernel range by default */ 233 ppage_descr->kernel_range = NULL; 233 ppage_descr->kernel_range = NULL; 234 234 235 list_add_tail(used_ppage, ppage_descr); 235 list_add_tail(used_ppage, ppage_descr); 236 physmem_used_pages ++; 236 physmem_used_pages ++; 237 237 238 /* The page is newly referenced */ 238 /* The page is newly referenced */ 239 return FALSE; 239 return FALSE; 240 } 240 } 241 241 242 /* The page was already referenced by someon 242 /* The page was already referenced by someone */ 243 return TRUE; 243 return TRUE; 244 } 244 } 245 245 246 246 247 sos_ret_t 247 sos_ret_t 248 sos_physmem_unref_physpage(sos_paddr_t ppage_p 248 sos_physmem_unref_physpage(sos_paddr_t ppage_paddr) 249 { 249 { 250 /* By default the return value indicates tha 250 /* By default the return value indicates that the page is still 251 used */ 251 used */ 252 sos_ret_t retval = FALSE; 252 sos_ret_t retval = FALSE; 253 253 254 struct physical_page_descr *ppage_descr 254 struct physical_page_descr *ppage_descr 255 = get_page_descr_at_paddr(ppage_paddr); 255 = get_page_descr_at_paddr(ppage_paddr); 256 256 257 if (! ppage_descr) 257 if (! ppage_descr) 258 return -SOS_EINVAL; 258 return -SOS_EINVAL; 259 259 260 /* Don't do anything if the page is not in t 260 /* Don't do anything if the page is not in the used list */ 261 if (ppage_descr->ref_cnt <= 0) 261 if (ppage_descr->ref_cnt <= 0) 262 return -SOS_EINVAL; 262 return -SOS_EINVAL; 263 263 264 /* Unreference the page, and, when no mappin 264 /* Unreference the page, and, when no mapping is active anymore, put 265 the page in the free list */ 265 the page in the free list */ 266 ppage_descr->ref_cnt--; 266 ppage_descr->ref_cnt--; 267 if (ppage_descr->ref_cnt <= 0) 267 if (ppage_descr->ref_cnt <= 0) 268 { 268 { 269 /* Reset associated kernel range */ 269 /* Reset associated kernel range */ 270 ppage_descr->kernel_range = NULL; 270 ppage_descr->kernel_range = NULL; 271 271 272 /* Transfer the page, considered USED, t 272 /* Transfer the page, considered USED, to the free list */ 273 list_delete(used_ppage, ppage_descr); 273 list_delete(used_ppage, ppage_descr); 274 physmem_used_pages --; 274 physmem_used_pages --; 275 list_add_head(free_ppage, ppage_descr); 275 list_add_head(free_ppage, ppage_descr); 276 276 277 /* Indicate that the page is now unrefer 277 /* Indicate that the page is now unreferenced */ 278 retval = TRUE; 278 retval = TRUE; 279 } 279 } 280 280 281 return retval; 281 return retval; 282 } 282 } 283 283 284 284 285 struct sos_kmem_range* sos_physmem_get_kmem_ra 285 struct sos_kmem_range* sos_physmem_get_kmem_range(sos_paddr_t ppage_paddr) 286 { 286 { 287 struct physical_page_descr *ppage_descr 287 struct physical_page_descr *ppage_descr 288 = get_page_descr_at_paddr(ppage_paddr); 288 = get_page_descr_at_paddr(ppage_paddr); 289 289 290 if (! ppage_descr) 290 if (! ppage_descr) 291 return NULL; 291 return NULL; 292 292 293 return ppage_descr->kernel_range; 293 return ppage_descr->kernel_range; 294 } 294 } 295 295 296 296 297 sos_ret_t sos_physmem_set_kmem_range(sos_paddr 297 sos_ret_t sos_physmem_set_kmem_range(sos_paddr_t ppage_paddr, 298 struct so 298 struct sos_kmem_range *range) 299 { 299 { 300 struct physical_page_descr *ppage_descr 300 struct physical_page_descr *ppage_descr 301 = get_page_descr_at_paddr(ppage_paddr); 301 = get_page_descr_at_paddr(ppage_paddr); 302 302 303 if (! ppage_descr) 303 if (! ppage_descr) 304 return -SOS_EINVAL; 304 return -SOS_EINVAL; 305 305 306 ppage_descr->kernel_range = range; 306 ppage_descr->kernel_range = range; 307 return SOS_OK; 307 return SOS_OK; 308 } 308 } 309 309 310 sos_ret_t sos_physmem_get_state(/* out */sos_c 310 sos_ret_t sos_physmem_get_state(/* out */sos_count_t *total_ppages, 311 /* out */sos_c 311 /* out */sos_count_t *used_ppages) 312 { 312 { 313 if (total_ppages) 313 if (total_ppages) 314 *total_ppages = physmem_total_pages; 314 *total_ppages = physmem_total_pages; 315 if (used_ppages) 315 if (used_ppages) 316 *used_ppages = physmem_used_pages; 316 *used_ppages = physmem_used_pages; 317 return SOS_OK; 317 return SOS_OK; 318 } 318 }
| [ source navigation ] | [ diff markup ] | [ identifier search ] | [ general search ] |