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 it is mapped in kernel space */ >> 036 struct sos_kmem_range *kernel_range; >> 037 035 /** The other pages on the list (used, free) 038 /** The other pages on the list (used, free) */ 036 struct physical_page_descr *prev, *next; 039 struct physical_page_descr *prev, *next; 037 }; 040 }; 038 041 039 /** These are some markers present in the exec 042 /** These are some markers present in the executable file (see sos.lds) */ 040 extern char __b_kernel, __e_kernel; 043 extern char __b_kernel, __e_kernel; 041 044 042 /** The array of ppage descriptors will be loc 045 /** The array of ppage descriptors will be located at this address */ 043 #define PAGE_DESCR_ARRAY_ADDR \ 046 #define PAGE_DESCR_ARRAY_ADDR \ 044 SOS_PAGE_ALIGN_SUP((sos_paddr_t) (& __e_kern 047 SOS_PAGE_ALIGN_SUP((sos_paddr_t) (& __e_kernel)) 045 static struct physical_page_descr * physical_p 048 static struct physical_page_descr * physical_page_descr_array; 046 049 047 /** The list of physical pages currently avail 050 /** The list of physical pages currently available */ 048 static struct physical_page_descr *free_ppage; 051 static struct physical_page_descr *free_ppage; 049 052 050 /** The list of physical pages currently in us 053 /** The list of physical pages currently in use */ 051 static struct physical_page_descr *used_ppage; 054 static struct physical_page_descr *used_ppage; 052 055 053 /** We will store here the interval of valid p 056 /** We will store here the interval of valid physical addresses */ 054 static sos_paddr_t physmem_base, physmem_top; 057 static sos_paddr_t physmem_base, physmem_top; 055 058 056 /** We store the number of pages used/free */ 059 /** We store the number of pages used/free */ 057 static sos_count_t physmem_total_pages, physme 060 static sos_count_t physmem_total_pages, physmem_used_pages; 058 061 059 sos_ret_t sos_physmem_setup(sos_size_t ram_siz 062 sos_ret_t sos_physmem_setup(sos_size_t ram_size, 060 /* out */sos_paddr 063 /* out */sos_paddr_t *kernel_core_base, 061 /* out */sos_paddr 064 /* out */sos_paddr_t *kernel_core_top) 062 { 065 { 063 /* The iterator over the page descriptors */ 066 /* The iterator over the page descriptors */ 064 struct physical_page_descr *ppage_descr; 067 struct physical_page_descr *ppage_descr; 065 068 066 /* The iterator over the physical addresses 069 /* The iterator over the physical addresses */ 067 sos_paddr_t ppage_addr; 070 sos_paddr_t ppage_addr; 068 071 069 /* Make sure ram size is aligned on a page b 072 /* Make sure ram size is aligned on a page boundary */ 070 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 */ 071 074 072 /* Reset the used/free page lists before bui 075 /* Reset the used/free page lists before building them */ 073 free_ppage = used_ppage = NULL; 076 free_ppage = used_ppage = NULL; 074 physmem_total_pages = physmem_used_pages = 0 077 physmem_total_pages = physmem_used_pages = 0; 075 078 076 /* Make sure that there is enough memory to 079 /* Make sure that there is enough memory to store the array of page 077 descriptors */ 080 descriptors */ 078 *kernel_core_base = SOS_PAGE_ALIGN_INF((sos_ 081 *kernel_core_base = SOS_PAGE_ALIGN_INF((sos_paddr_t)(& __b_kernel)); 079 *kernel_core_top 082 *kernel_core_top 080 = PAGE_DESCR_ARRAY_ADDR 083 = PAGE_DESCR_ARRAY_ADDR 081 + SOS_PAGE_ALIGN_SUP( (ram_size >> SOS_P 084 + SOS_PAGE_ALIGN_SUP( (ram_size >> SOS_PAGE_SHIFT) 082 * sizeof(struct ph 085 * sizeof(struct physical_page_descr)); 083 if (*kernel_core_top > ram_size) 086 if (*kernel_core_top > ram_size) 084 return -SOS_ENOMEM; 087 return -SOS_ENOMEM; 085 088 086 /* 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 087 means to signal "no page available" */ 090 means to signal "no page available" */ 088 physmem_base = SOS_PAGE_SIZE; 091 physmem_base = SOS_PAGE_SIZE; 089 physmem_top = ram_size; 092 physmem_top = ram_size; 090 093 091 /* Setup the page descriptor arrray */ 094 /* Setup the page descriptor arrray */ 092 physical_page_descr_array 095 physical_page_descr_array 093 = (struct physical_page_descr*)PAGE_DESCR_ 096 = (struct physical_page_descr*)PAGE_DESCR_ARRAY_ADDR; 094 097 095 /* Scan the list of physical pages */ 098 /* Scan the list of physical pages */ 096 for (ppage_addr = 0, 099 for (ppage_addr = 0, 097 ppage_descr = physical_page_descr_arr 100 ppage_descr = physical_page_descr_array ; 098 ppage_addr < physmem_top ; 101 ppage_addr < physmem_top ; 099 ppage_addr += SOS_PAGE_SIZE, 102 ppage_addr += SOS_PAGE_SIZE, 100 ppage_descr ++) 103 ppage_descr ++) 101 { 104 { 102 enum { PPAGE_MARK_RESERVED, PPAGE_MARK_F 105 enum { PPAGE_MARK_RESERVED, PPAGE_MARK_FREE, 103 PPAGE_MARK_KERNEL, PPAGE_MARK_HWM 106 PPAGE_MARK_KERNEL, PPAGE_MARK_HWMAP } todo; 104 107 105 memset(ppage_descr, 0x0, sizeof(struct p 108 memset(ppage_descr, 0x0, sizeof(struct physical_page_descr)); 106 109 107 /* Init the page descriptor for this pag 110 /* Init the page descriptor for this page */ 108 ppage_descr->paddr = ppage_addr; 111 ppage_descr->paddr = ppage_addr; 109 112 110 /* Reserved : 0 ... base */ 113 /* Reserved : 0 ... base */ 111 if (ppage_addr < physmem_base) 114 if (ppage_addr < physmem_base) 112 todo = PPAGE_MARK_RESERVED; 115 todo = PPAGE_MARK_RESERVED; 113 116 114 /* Free : base ... BIOS */ 117 /* Free : base ... BIOS */ 115 else if ((ppage_addr >= physmem_base) 118 else if ((ppage_addr >= physmem_base) 116 && (ppage_addr < BIOS_N_VIDEO_S 119 && (ppage_addr < BIOS_N_VIDEO_START)) 117 todo = PPAGE_MARK_FREE; 120 todo = PPAGE_MARK_FREE; 118 121 119 /* Used : BIOS */ 122 /* Used : BIOS */ 120 else if ((ppage_addr >= BIOS_N_VIDEO_STA 123 else if ((ppage_addr >= BIOS_N_VIDEO_START) 121 && (ppage_addr < BIOS_N_VIDEO_E 124 && (ppage_addr < BIOS_N_VIDEO_END)) 122 todo = PPAGE_MARK_HWMAP; 125 todo = PPAGE_MARK_HWMAP; 123 126 124 /* Free : BIOS ... kernel */ 127 /* Free : BIOS ... kernel */ 125 else if ((ppage_addr >= BIOS_N_VIDEO_END 128 else if ((ppage_addr >= BIOS_N_VIDEO_END) 126 && (ppage_addr < (sos_paddr_t) 129 && (ppage_addr < (sos_paddr_t) (& __b_kernel))) 127 todo = PPAGE_MARK_FREE; 130 todo = PPAGE_MARK_FREE; 128 131 129 /* Used : Kernel code/data/bss + physcal 132 /* Used : Kernel code/data/bss + physcal page descr array */ 130 else if ((ppage_addr >= *kernel_core_bas 133 else if ((ppage_addr >= *kernel_core_base) 131 && (ppage_addr < *kernel_core_ 134 && (ppage_addr < *kernel_core_top)) 132 todo = PPAGE_MARK_KERNEL; 135 todo = PPAGE_MARK_KERNEL; 133 136 134 /* Free : first page of descr ... end of 137 /* Free : first page of descr ... end of RAM */ 135 else 138 else 136 todo = PPAGE_MARK_FREE; 139 todo = PPAGE_MARK_FREE; 137 140 138 /* Actually does the insertion in the us 141 /* Actually does the insertion in the used/free page lists */ 139 physmem_total_pages ++; 142 physmem_total_pages ++; 140 switch (todo) 143 switch (todo) 141 { 144 { 142 case PPAGE_MARK_FREE: 145 case PPAGE_MARK_FREE: 143 ppage_descr->ref_cnt = 0; 146 ppage_descr->ref_cnt = 0; 144 list_add_head(free_ppage, ppage_desc 147 list_add_head(free_ppage, ppage_descr); 145 break; 148 break; 146 149 147 case PPAGE_MARK_KERNEL: 150 case PPAGE_MARK_KERNEL: 148 case PPAGE_MARK_HWMAP: 151 case PPAGE_MARK_HWMAP: 149 ppage_descr->ref_cnt = 1; 152 ppage_descr->ref_cnt = 1; 150 list_add_head(used_ppage, ppage_desc 153 list_add_head(used_ppage, ppage_descr); 151 physmem_used_pages ++; 154 physmem_used_pages ++; 152 break; 155 break; 153 156 154 default: 157 default: 155 /* Reserved page: nop */ 158 /* Reserved page: nop */ 156 break; 159 break; 157 } 160 } 158 } 161 } 159 162 160 return SOS_OK; 163 return SOS_OK; 161 } 164 } 162 165 163 166 164 sos_paddr_t sos_physmem_ref_physpage_new(sos_b 167 sos_paddr_t sos_physmem_ref_physpage_new(sos_bool_t can_block) 165 { 168 { 166 struct physical_page_descr *ppage_descr; 169 struct physical_page_descr *ppage_descr; 167 170 168 if (! free_ppage) 171 if (! free_ppage) 169 return (sos_paddr_t)NULL; 172 return (sos_paddr_t)NULL; 170 173 171 /* Retrieve a page in the free list */ 174 /* Retrieve a page in the free list */ 172 ppage_descr = list_pop_head(free_ppage); 175 ppage_descr = list_pop_head(free_ppage); 173 176 174 /* The page is assumed not to be already use 177 /* The page is assumed not to be already used */ 175 SOS_ASSERT_FATAL(ppage_descr->ref_cnt == 0); 178 SOS_ASSERT_FATAL(ppage_descr->ref_cnt == 0); 176 179 177 /* Mark the page as used (this of course set 180 /* Mark the page as used (this of course sets the ref count to 1) */ 178 ppage_descr->ref_cnt ++; 181 ppage_descr->ref_cnt ++; 179 182 >> 183 /* No associated kernel range by default */ >> 184 ppage_descr->kernel_range = NULL; >> 185 180 /* Put the page in the used list */ 186 /* Put the page in the used list */ 181 list_add_tail(used_ppage, ppage_descr); 187 list_add_tail(used_ppage, ppage_descr); 182 physmem_used_pages ++; 188 physmem_used_pages ++; 183 189 184 return ppage_descr->paddr; 190 return ppage_descr->paddr; 185 } 191 } 186 192 187 193 188 /** 194 /** 189 * Helper function to get the physical page de 195 * Helper function to get the physical page descriptor for the given 190 * physical page address. 196 * physical page address. 191 * 197 * 192 * @return NULL when out-of-bounds or non-page 198 * @return NULL when out-of-bounds or non-page-aligned 193 */ 199 */ 194 inline static struct physical_page_descr * 200 inline static struct physical_page_descr * 195 get_page_descr_at_paddr(sos_paddr_t ppage_padd 201 get_page_descr_at_paddr(sos_paddr_t ppage_paddr) 196 { 202 { 197 /* Don't handle non-page-aligned addresses * 203 /* Don't handle non-page-aligned addresses */ 198 if (ppage_paddr & SOS_PAGE_MASK) 204 if (ppage_paddr & SOS_PAGE_MASK) 199 return NULL; 205 return NULL; 200 206 201 /* Don't support out-of-bounds requests */ 207 /* Don't support out-of-bounds requests */ 202 if ((ppage_paddr < physmem_base) || (ppage_p 208 if ((ppage_paddr < physmem_base) || (ppage_paddr >= physmem_top)) 203 return NULL; 209 return NULL; 204 210 205 return physical_page_descr_array + (ppage_pa 211 return physical_page_descr_array + (ppage_paddr >> SOS_PAGE_SHIFT); 206 } 212 } 207 213 208 214 209 sos_ret_t sos_physmem_ref_physpage_at(sos_padd 215 sos_ret_t sos_physmem_ref_physpage_at(sos_paddr_t ppage_paddr) 210 { 216 { 211 struct physical_page_descr *ppage_descr 217 struct physical_page_descr *ppage_descr 212 = get_page_descr_at_paddr(ppage_paddr); 218 = get_page_descr_at_paddr(ppage_paddr); 213 219 214 if (! ppage_descr) 220 if (! ppage_descr) 215 return -SOS_EINVAL; 221 return -SOS_EINVAL; 216 222 217 /* Increment the reference count for the pag 223 /* Increment the reference count for the page */ 218 ppage_descr->ref_cnt ++; 224 ppage_descr->ref_cnt ++; 219 225 220 /* If the page is newly referenced (ie we ar 226 /* If the page is newly referenced (ie we are the only owners of the 221 page => ref cnt == 1), transfer it in the 227 page => ref cnt == 1), transfer it in the used pages list */ 222 if (ppage_descr->ref_cnt == 1) 228 if (ppage_descr->ref_cnt == 1) 223 { 229 { 224 list_delete(free_ppage, ppage_descr); 230 list_delete(free_ppage, ppage_descr); >> 231 >> 232 /* No associated kernel range by default */ >> 233 ppage_descr->kernel_range = NULL; >> 234 225 list_add_tail(used_ppage, ppage_descr); 235 list_add_tail(used_ppage, ppage_descr); 226 physmem_used_pages ++; 236 physmem_used_pages ++; 227 237 228 /* The page is newly referenced */ 238 /* The page is newly referenced */ 229 return FALSE; 239 return FALSE; 230 } 240 } 231 241 232 /* The page was already referenced by someon 242 /* The page was already referenced by someone */ 233 return TRUE; 243 return TRUE; 234 } 244 } 235 245 236 246 237 sos_ret_t 247 sos_ret_t 238 sos_physmem_unref_physpage(sos_paddr_t ppage_p 248 sos_physmem_unref_physpage(sos_paddr_t ppage_paddr) 239 { 249 { 240 /* By default the return value indicates tha 250 /* By default the return value indicates that the page is still 241 used */ 251 used */ 242 sos_ret_t retval = FALSE; 252 sos_ret_t retval = FALSE; 243 253 244 struct physical_page_descr *ppage_descr 254 struct physical_page_descr *ppage_descr 245 = get_page_descr_at_paddr(ppage_paddr); 255 = get_page_descr_at_paddr(ppage_paddr); 246 256 247 if (! ppage_descr) 257 if (! ppage_descr) 248 return -SOS_EINVAL; 258 return -SOS_EINVAL; 249 259 250 /* 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 */ 251 if (ppage_descr->ref_cnt <= 0) 261 if (ppage_descr->ref_cnt <= 0) 252 return -SOS_EINVAL; 262 return -SOS_EINVAL; 253 263 254 /* Unreference the page, and, when no mappin 264 /* Unreference the page, and, when no mapping is active anymore, put 255 the page in the free list */ 265 the page in the free list */ 256 ppage_descr->ref_cnt--; 266 ppage_descr->ref_cnt--; 257 if (ppage_descr->ref_cnt <= 0) 267 if (ppage_descr->ref_cnt <= 0) 258 { 268 { >> 269 /* Reset associated kernel range */ >> 270 ppage_descr->kernel_range = NULL; >> 271 259 /* Transfer the page, considered USED, t 272 /* Transfer the page, considered USED, to the free list */ 260 list_delete(used_ppage, ppage_descr); 273 list_delete(used_ppage, ppage_descr); 261 physmem_used_pages --; 274 physmem_used_pages --; 262 list_add_head(free_ppage, ppage_descr); 275 list_add_head(free_ppage, ppage_descr); 263 276 264 /* Indicate that the page is now unrefer 277 /* Indicate that the page is now unreferenced */ 265 retval = TRUE; 278 retval = TRUE; 266 } 279 } 267 280 268 return retval; 281 return retval; >> 282 } >> 283 >> 284 >> 285 struct sos_kmem_range* sos_physmem_get_kmem_range(sos_paddr_t ppage_paddr) >> 286 { >> 287 struct physical_page_descr *ppage_descr >> 288 = get_page_descr_at_paddr(ppage_paddr); >> 289 >> 290 if (! ppage_descr) >> 291 return NULL; >> 292 >> 293 return ppage_descr->kernel_range; >> 294 } >> 295 >> 296 >> 297 sos_ret_t sos_physmem_set_kmem_range(sos_paddr_t ppage_paddr, >> 298 struct sos_kmem_range *range) >> 299 { >> 300 struct physical_page_descr *ppage_descr >> 301 = get_page_descr_at_paddr(ppage_paddr); >> 302 >> 303 if (! ppage_descr) >> 304 return -SOS_EINVAL; >> 305 >> 306 ppage_descr->kernel_range = range; >> 307 return SOS_OK; >> 308 } >> 309 >> 310 sos_ret_t sos_physmem_get_state(/* out */sos_count_t *total_ppages, >> 311 /* out */sos_count_t *used_ppages) >> 312 { >> 313 if (total_ppages) >> 314 *total_ppages = physmem_total_pages; >> 315 if (used_ppages) >> 316 *used_ppages = physmem_used_pages; >> 317 return SOS_OK; 269 } 318 }
| [ source navigation ] | [ diff markup ] | [ identifier search ] | [ general search ] |