[1] | 1 | /* |
---|
[606] | 2 | * mapper.c - Kernel cache for FS files or directories implementation. |
---|
[1] | 3 | * |
---|
| 4 | * Authors Mohamed Lamine Karaoui (2015) |
---|
[683] | 5 | * Alain Greiner (2016,2017,2018,2019,2020) |
---|
[1] | 6 | * |
---|
| 7 | * Copyright (c) UPMC Sorbonne Universites |
---|
| 8 | * |
---|
| 9 | * This file is part of ALMOS-MKH. |
---|
| 10 | * |
---|
| 11 | * ALMOS-MKH is free software; you can redistribute it and/or modify it |
---|
| 12 | * under the terms of the GNU General Public License as published by |
---|
| 13 | * the Free Software Foundation; version 2.0 of the License. |
---|
| 14 | * |
---|
| 15 | * ALMOS-MKH is distributed in the hope that it will be useful, but |
---|
| 16 | * WITHOUT ANY WARRANTY; without even the implied warranty of |
---|
| 17 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU |
---|
| 18 | * General Public License for more details. |
---|
| 19 | * |
---|
| 20 | * You should have received a copy of the GNU General Public License |
---|
| 21 | * along with ALMOS-MKH; if not, write to the Free Software Foundation, |
---|
| 22 | * Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA |
---|
| 23 | */ |
---|
| 24 | |
---|
[14] | 25 | #include <kernel_config.h> |
---|
[457] | 26 | #include <hal_kernel_types.h> |
---|
[1] | 27 | #include <hal_special.h> |
---|
[23] | 28 | #include <hal_uspace.h> |
---|
[656] | 29 | #include <hal_vmm.h> |
---|
[1] | 30 | #include <grdxt.h> |
---|
[614] | 31 | #include <string.h> |
---|
[1] | 32 | #include <rwlock.h> |
---|
| 33 | #include <printk.h> |
---|
[279] | 34 | #include <memcpy.h> |
---|
[1] | 35 | #include <thread.h> |
---|
| 36 | #include <core.h> |
---|
| 37 | #include <process.h> |
---|
| 38 | #include <kmem.h> |
---|
| 39 | #include <kcm.h> |
---|
[567] | 40 | #include <ppm.h> |
---|
[1] | 41 | #include <page.h> |
---|
| 42 | #include <cluster.h> |
---|
| 43 | #include <vfs.h> |
---|
| 44 | #include <mapper.h> |
---|
[614] | 45 | #include <dev_ioc.h> |
---|
[1] | 46 | |
---|
[567] | 47 | |
---|
[657] | 48 | ///////////////////////////////////// |
---|
| 49 | xptr_t mapper_create( cxy_t cxy, |
---|
| 50 | uint32_t type ) |
---|
[1] | 51 | { |
---|
[657] | 52 | mapper_t * mapper_ptr; |
---|
[1] | 53 | error_t error; |
---|
| 54 | |
---|
[635] | 55 | // allocate memory for mapper descriptor |
---|
[683] | 56 | mapper_ptr = kmem_remote_alloc( cxy , bits_log2(sizeof(mapper_t)) , AF_ZERO ); |
---|
[1] | 57 | |
---|
[657] | 58 | if( mapper_ptr == NULL ) |
---|
[1] | 59 | { |
---|
[683] | 60 | |
---|
| 61 | #if DEBUG_MAPPER_ERROR |
---|
| 62 | printk("\n[ERROR] in %s : no memory for mapper descriptor\n", __FUNCTION__ ); |
---|
| 63 | #endif |
---|
[657] | 64 | return XPTR_NULL; |
---|
[1] | 65 | } |
---|
| 66 | |
---|
[657] | 67 | // initialize refcount and type |
---|
| 68 | hal_remote_s32( XPTR( cxy , &mapper_ptr->refcount ) , 0 ); |
---|
| 69 | hal_remote_s32( XPTR( cxy , &mapper_ptr->fs_type ) , type ); |
---|
[1] | 70 | |
---|
| 71 | // initialize radix tree |
---|
[657] | 72 | error = grdxt_remote_init( XPTR( cxy , &mapper_ptr->rt ), |
---|
| 73 | CONFIG_MAPPER_GRDXT_W1, |
---|
| 74 | CONFIG_MAPPER_GRDXT_W2, |
---|
| 75 | CONFIG_MAPPER_GRDXT_W3 ); |
---|
[1] | 76 | if( error ) |
---|
| 77 | { |
---|
[683] | 78 | |
---|
| 79 | #if DEBUG_MAPPER_ERROR |
---|
| 80 | printk("\n[ERROR] in %s : cannot initialize radix tree\n", __FUNCTION__ ); |
---|
| 81 | kmem_remote_free( cxy , mapper_ptr , bits_log2(sizeof(mapper_t)) ); |
---|
| 82 | #endif |
---|
[657] | 83 | return XPTR_NULL; |
---|
[1] | 84 | } |
---|
| 85 | |
---|
| 86 | // initialize mapper lock |
---|
[657] | 87 | remote_rwlock_init( XPTR( cxy , &mapper_ptr->lock ) , LOCK_MAPPER_STATE ); |
---|
[1] | 88 | |
---|
| 89 | // initialize waiting threads xlist (empty) |
---|
[657] | 90 | xlist_root_init( XPTR( cxy , &mapper_ptr->wait_root ) ); |
---|
[1] | 91 | |
---|
| 92 | // initialize vsegs xlist (empty) |
---|
[657] | 93 | xlist_root_init( XPTR( cxy , &mapper_ptr->vsegs_root ) ); |
---|
[1] | 94 | |
---|
[657] | 95 | return XPTR( cxy , mapper_ptr ); |
---|
[1] | 96 | |
---|
[204] | 97 | } // end mapper_create() |
---|
| 98 | |
---|
[606] | 99 | //////////////////////////////////////// |
---|
[657] | 100 | void mapper_destroy( xptr_t mapper_xp ) |
---|
[1] | 101 | { |
---|
[657] | 102 | xptr_t page_xp; |
---|
[1] | 103 | page_t * page; |
---|
| 104 | uint32_t found_index = 0; |
---|
| 105 | uint32_t start_index = 0; |
---|
| 106 | |
---|
[657] | 107 | cxy_t mapper_cxy = GET_CXY( mapper_xp ); |
---|
| 108 | mapper_t * mapper_ptr = GET_PTR( mapper_xp ); |
---|
| 109 | |
---|
| 110 | // build extended pointer on radix tree |
---|
| 111 | xptr_t rt_xp = XPTR( mapper_cxy , &mapper_ptr->rt ); |
---|
| 112 | |
---|
[606] | 113 | // scan radix tree |
---|
[1] | 114 | do |
---|
| 115 | { |
---|
| 116 | // get page from radix tree |
---|
[657] | 117 | page_xp = grdxt_remote_get_first( rt_xp, |
---|
| 118 | start_index , |
---|
| 119 | &found_index ); |
---|
| 120 | page = GET_PTR( page_xp ); |
---|
| 121 | |
---|
[606] | 122 | // release registered pages to PPM |
---|
[18] | 123 | if( page != NULL ) |
---|
[1] | 124 | { |
---|
| 125 | // remove page from mapper and release to PPM |
---|
[657] | 126 | mapper_remote_release_page( mapper_xp , page ); |
---|
[1] | 127 | |
---|
| 128 | // update start_key value for next page |
---|
| 129 | start_index = found_index; |
---|
| 130 | } |
---|
| 131 | } |
---|
| 132 | while( page != NULL ); |
---|
| 133 | |
---|
[606] | 134 | // release the memory allocated to radix tree itself |
---|
[657] | 135 | grdxt_remote_destroy( rt_xp ); |
---|
[1] | 136 | |
---|
| 137 | // release memory for mapper descriptor |
---|
[683] | 138 | kmem_remote_free( mapper_cxy , mapper_ptr , bits_log2(sizeof(mapper_t)) ); |
---|
[1] | 139 | |
---|
[204] | 140 | } // end mapper_destroy() |
---|
| 141 | |
---|
[657] | 142 | ///////////////////////////////////////////////// |
---|
| 143 | error_t mapper_handle_miss( xptr_t mapper_xp, |
---|
| 144 | uint32_t page_id, |
---|
| 145 | xptr_t * page_xp_ptr ) |
---|
[635] | 146 | { |
---|
| 147 | error_t error; |
---|
| 148 | |
---|
[657] | 149 | uint32_t inode_size = 0; |
---|
| 150 | uint32_t inode_type = 0; |
---|
[656] | 151 | |
---|
[683] | 152 | #if DEBUG_MAPPER_HANDLE_MISS || DEBUG_MAPPER_ERROR |
---|
| 153 | thread_t * this = CURRENT_THREAD; |
---|
| 154 | uint32_t cycle = (uint32_t)hal_get_cycles(); |
---|
| 155 | #endif |
---|
[635] | 156 | |
---|
| 157 | // get target mapper cluster and local pointer |
---|
[656] | 158 | cxy_t mapper_cxy = GET_CXY( mapper_xp ); |
---|
| 159 | mapper_t * mapper_ptr = GET_PTR( mapper_xp ); |
---|
[635] | 160 | |
---|
[656] | 161 | // get inode pointer |
---|
| 162 | vfs_inode_t * inode = hal_remote_lpt( XPTR( mapper_cxy , &mapper_ptr->inode ) ); |
---|
| 163 | |
---|
| 164 | // get inode size and type if relevant |
---|
| 165 | if( inode != NULL ) |
---|
| 166 | { |
---|
| 167 | inode_size = hal_remote_l32( XPTR( mapper_cxy , &inode->size ) ); |
---|
| 168 | inode_type = hal_remote_l32( XPTR( mapper_cxy , &inode->type ) ); |
---|
| 169 | } |
---|
| 170 | |
---|
[635] | 171 | #if DEBUG_MAPPER_HANDLE_MISS |
---|
| 172 | char name[CONFIG_VFS_MAX_NAME_LENGTH]; |
---|
| 173 | if( (DEBUG_MAPPER_HANDLE_MISS < cycle) && (inode != NULL) ) |
---|
| 174 | { |
---|
[656] | 175 | vfs_inode_get_name( XPTR( mapper_cxy , inode ) , name ); |
---|
| 176 | printk("\n[%s] thread[%x,%x] enter for page %d in <%s> / cxy %x / cycle %d\n", |
---|
[635] | 177 | __FUNCTION__, this->process->pid, this->trdid, page_id, name, mapper_cxy, cycle ); |
---|
| 178 | } |
---|
| 179 | if( (DEBUG_MAPPER_HANDLE_MISS < cycle) && (inode == NULL) ) |
---|
| 180 | { |
---|
[656] | 181 | printk("\n[%s] thread[%x,%x] enter for page %d in FAT / cxy %x / cycle %d\n", |
---|
[635] | 182 | __FUNCTION__, this->process->pid, this->trdid, page_id, mapper_cxy, cycle ); |
---|
| 183 | } |
---|
| 184 | #endif |
---|
| 185 | |
---|
[683] | 186 | #if( DEBUG_MAPPER_HANDLE_MISS & 1 ) |
---|
[656] | 187 | if( DEBUG_MAPPER_HANDLE_MISS < cycle ) |
---|
| 188 | { |
---|
| 189 | if (inode != NULL) grdxt_remote_display( XPTR( mapper_cxy , &mapper_ptr->rt ) , name ); |
---|
| 190 | else grdxt_remote_display( XPTR( mapper_cxy , &mapper_ptr->rt ) , "FAT" ); |
---|
| 191 | } |
---|
| 192 | #endif |
---|
| 193 | |
---|
[683] | 194 | // allocate one 4 Kbytes page in the remote mapper cluster |
---|
| 195 | void * base_ptr = kmem_remote_alloc( mapper_cxy , 12 , AF_NONE ); |
---|
| 196 | |
---|
| 197 | if( base_ptr == NULL ) |
---|
[635] | 198 | { |
---|
[683] | 199 | |
---|
| 200 | #if DEBUG_MAPPER_ERROR |
---|
| 201 | printk("\n[ERROR] in %s : thread [%x,%x] cannot allocate page in cluster %x / cycle %d\n", |
---|
| 202 | __FUNCTION__ , this->process->pid, this->trdid , mapper_cxy , cycle ); |
---|
| 203 | #endif |
---|
[635] | 204 | return -1; |
---|
| 205 | } |
---|
| 206 | |
---|
[683] | 207 | // get pointers on allocated page descrptor |
---|
| 208 | xptr_t page_xp = ppm_base2page( XPTR( mapper_cxy , base_ptr ) ); |
---|
| 209 | page_t * page_ptr = GET_PTR( page_xp ); |
---|
| 210 | |
---|
[635] | 211 | // initialize the page descriptor |
---|
| 212 | page_remote_init( page_xp ); |
---|
| 213 | |
---|
[656] | 214 | // initialize specific page descriptor fields |
---|
[635] | 215 | hal_remote_s32( XPTR( mapper_cxy , &page_ptr->refcount ) , 1 ); |
---|
| 216 | hal_remote_s32( XPTR( mapper_cxy , &page_ptr->index ) , page_id ); |
---|
| 217 | hal_remote_spt( XPTR( mapper_cxy , &page_ptr->mapper ) , mapper_ptr ); |
---|
| 218 | hal_remote_s32( XPTR( mapper_cxy , &page_ptr->flags ) , PG_INIT ); |
---|
| 219 | |
---|
| 220 | // insert page in mapper radix tree |
---|
| 221 | error = grdxt_remote_insert( XPTR( mapper_cxy , &mapper_ptr->rt), |
---|
| 222 | page_id, |
---|
| 223 | page_ptr ); |
---|
| 224 | if( error ) |
---|
| 225 | { |
---|
[683] | 226 | |
---|
| 227 | #if DEBUG_MAPPER_ERROR |
---|
| 228 | printk("\n[ERROR] in %s : thread[%x,%x] cannot insert page in mapper / cycle %d\n", |
---|
| 229 | __FUNCTION__ , this->process->pid, this->trdid , cycle ); |
---|
| 230 | ppm_remote_free_pages( mapper_cxy , page_ptr ); |
---|
| 231 | #endif |
---|
[635] | 232 | return -1; |
---|
| 233 | } |
---|
| 234 | |
---|
[656] | 235 | // launch I/O operation to load page from IOC device when required: |
---|
| 236 | // - it is the FAT mapper |
---|
| 237 | // - it is a directory mapper |
---|
| 238 | // - it is a file mapper, and it exist data on IOC device for this page |
---|
[672] | 239 | if( (inode == NULL) || (inode_type == FILE_TYPE_DIR) || (inode_size > (page_id << 10) ) ) |
---|
[656] | 240 | { |
---|
| 241 | error = vfs_fs_move_page( page_xp , IOC_SYNC_READ ); |
---|
[635] | 242 | |
---|
[656] | 243 | if( error ) |
---|
| 244 | { |
---|
[683] | 245 | |
---|
| 246 | #if DEBUG_MAPPER_ERROR |
---|
| 247 | printk("\n[ERROR] in %s : thread[%x,%x] cannot load page from device / cycle %d\n", |
---|
| 248 | __FUNCTION__ , this->process->pid, this->trdid , cycle ); |
---|
| 249 | mapper_remote_release_page( mapper_xp , page_ptr ); |
---|
| 250 | #endif |
---|
[656] | 251 | return -1; |
---|
| 252 | } |
---|
[635] | 253 | } |
---|
| 254 | |
---|
| 255 | // return extended pointer on allocated page |
---|
| 256 | *page_xp_ptr = page_xp; |
---|
| 257 | |
---|
| 258 | #if DEBUG_MAPPER_HANDLE_MISS |
---|
[656] | 259 | ppn_t ppn = ppm_page2ppn( page_xp ); |
---|
[635] | 260 | if( (DEBUG_MAPPER_HANDLE_MISS < cycle) && (inode != NULL) ) |
---|
| 261 | { |
---|
[656] | 262 | printk("\n[%s] thread[%x,%x] exit for page %d in <%s> / page %x / ppn %x\n", |
---|
| 263 | __FUNCTION__, this->process->pid, this->trdid, page_id, name, page_ptr, ppn ); |
---|
[635] | 264 | } |
---|
| 265 | if( (DEBUG_MAPPER_HANDLE_MISS < cycle) && (inode == NULL) ) |
---|
| 266 | { |
---|
[656] | 267 | printk("\n[%s] thread[%x,%x] exit for page %d in FAT / page %x / ppn %x\n", |
---|
| 268 | __FUNCTION__, this->process->pid, this->trdid, page_id, page_ptr, ppn ); |
---|
[635] | 269 | } |
---|
| 270 | #endif |
---|
| 271 | |
---|
[683] | 272 | #if( DEBUG_MAPPER_HANDLE_MISS & 1 ) |
---|
[656] | 273 | if( DEBUG_MAPPER_HANDLE_MISS < cycle ) |
---|
| 274 | { |
---|
| 275 | if (inode != NULL) grdxt_remote_display( XPTR( mapper_cxy , &mapper_ptr->rt ) , name ); |
---|
| 276 | else grdxt_remote_display( XPTR( mapper_cxy , &mapper_ptr->rt ) , "FAT" ); |
---|
| 277 | } |
---|
| 278 | #endif |
---|
| 279 | |
---|
[635] | 280 | return 0; |
---|
| 281 | |
---|
[657] | 282 | } // end mapper_handle_miss() |
---|
[635] | 283 | |
---|
[657] | 284 | ///////////////////////////////////////////// |
---|
| 285 | xptr_t mapper_get_page( xptr_t mapper_xp, |
---|
| 286 | uint32_t page_id ) |
---|
[1] | 287 | { |
---|
[183] | 288 | error_t error; |
---|
[1] | 289 | |
---|
[606] | 290 | thread_t * this = CURRENT_THREAD; |
---|
| 291 | |
---|
| 292 | // get mapper cluster and local pointer |
---|
[656] | 293 | mapper_t * mapper_ptr = GET_PTR( mapper_xp ); |
---|
| 294 | cxy_t mapper_cxy = GET_CXY( mapper_xp ); |
---|
[606] | 295 | |
---|
[672] | 296 | assert( __FUNCTION__, (hal_remote_lpt( XPTR( mapper_cxy , &mapper_ptr->inode ) ) != NULL ), |
---|
[657] | 297 | "should not be used for the FAT mapper"); |
---|
| 298 | |
---|
[438] | 299 | #if DEBUG_MAPPER_GET_PAGE |
---|
[625] | 300 | uint32_t cycle = (uint32_t)hal_get_cycles(); |
---|
[606] | 301 | char name[CONFIG_VFS_MAX_NAME_LENGTH]; |
---|
[657] | 302 | if( DEBUG_MAPPER_GET_PAGE < cycle ) |
---|
[625] | 303 | { |
---|
[657] | 304 | vfs_inode_t * inode = hal_remote_lpt( XPTR( mapper_cxy , &mapper_ptr->inode ) ); |
---|
[625] | 305 | vfs_inode_get_name( XPTR( mapper_cxy , inode ) , name ); |
---|
| 306 | printk("\n[%s] thread[%x,%x] enter for page %d of <%s> mapper / cycle %d\n", |
---|
| 307 | __FUNCTION__, this->process->pid, this->trdid, page_id, name, cycle ); |
---|
| 308 | } |
---|
[435] | 309 | #endif |
---|
[204] | 310 | |
---|
[683] | 311 | #if( DEBUG_MAPPER_GET_PAGE & 1 ) |
---|
[656] | 312 | if( DEBUG_MAPPER_GET_PAGE < cycle ) |
---|
| 313 | ppm_remote_display( local_cxy ); |
---|
| 314 | #endif |
---|
| 315 | |
---|
[581] | 316 | // check thread can yield |
---|
| 317 | thread_assert_can_yield( this , __FUNCTION__ ); |
---|
| 318 | |
---|
[606] | 319 | // build extended pointer on mapper lock and mapper rt |
---|
[656] | 320 | xptr_t lock_xp = XPTR( mapper_cxy , &mapper_ptr->lock ); |
---|
| 321 | xptr_t rt_xp = XPTR( mapper_cxy , &mapper_ptr->rt ); |
---|
[606] | 322 | |
---|
[1] | 323 | // take mapper lock in READ_MODE |
---|
[606] | 324 | remote_rwlock_rd_acquire( lock_xp ); |
---|
[1] | 325 | |
---|
| 326 | // search page in radix tree |
---|
[656] | 327 | xptr_t page_xp = grdxt_remote_lookup( rt_xp , page_id ); |
---|
[1] | 328 | |
---|
[606] | 329 | // test mapper miss |
---|
[635] | 330 | if( page_xp == XPTR_NULL ) // miss => handle it |
---|
[1] | 331 | { |
---|
| 332 | // release the lock in READ_MODE and take it in WRITE_MODE |
---|
[606] | 333 | remote_rwlock_rd_release( lock_xp ); |
---|
| 334 | remote_rwlock_wr_acquire( lock_xp ); |
---|
[1] | 335 | |
---|
[606] | 336 | // second test on missing page because the page status can be modified |
---|
[1] | 337 | // by another thread, when passing from READ_MODE to WRITE_MODE. |
---|
| 338 | // from this point there is no concurrent accesses to mapper. |
---|
[606] | 339 | page_xp = grdxt_remote_lookup( rt_xp , page_id ); |
---|
[1] | 340 | |
---|
[606] | 341 | if ( page_xp == XPTR_NULL ) // miss confirmed => handle it |
---|
[1] | 342 | { |
---|
[657] | 343 | error = mapper_handle_miss( mapper_xp, |
---|
| 344 | page_id, |
---|
| 345 | &page_xp ); |
---|
[635] | 346 | if( error ) |
---|
[610] | 347 | { |
---|
[683] | 348 | |
---|
| 349 | #if DEBUG_MAPPER_ERROR |
---|
| 350 | printk("\n[ERROR] in %s : thread[%x,%x] cannot handle mapper miss\n", |
---|
| 351 | __FUNCTION__ , this->process->pid, this->trdid ); |
---|
| 352 | remote_rwlock_wr_release( lock_xp ); |
---|
| 353 | #endif |
---|
[606] | 354 | return XPTR_NULL; |
---|
[1] | 355 | } |
---|
| 356 | } |
---|
[635] | 357 | |
---|
| 358 | #if (DEBUG_MAPPER_GET_PAGE & 1) |
---|
[657] | 359 | if( DEBUG_MAPPER_GET_PAGE < cycle ) |
---|
| 360 | printk("\n[%s] thread[%x,%x] introduced missing page %d in <%s> mapper / ppn %x\n", |
---|
| 361 | __FUNCTION__, this->process->pid, this->trdid, page_id, name, ppm_page2ppn(page_xp) ); |
---|
[635] | 362 | #endif |
---|
[606] | 363 | |
---|
| 364 | // release mapper lock from WRITE_MODE |
---|
| 365 | remote_rwlock_wr_release( lock_xp ); |
---|
[1] | 366 | } |
---|
[606] | 367 | else // hit |
---|
[1] | 368 | { |
---|
[606] | 369 | // release mapper lock from READ_MODE |
---|
| 370 | remote_rwlock_rd_release( lock_xp ); |
---|
[1] | 371 | } |
---|
| 372 | |
---|
[438] | 373 | #if DEBUG_MAPPER_GET_PAGE |
---|
[657] | 374 | if( DEBUG_MAPPER_GET_PAGE < cycle ) |
---|
| 375 | printk("\n[%s] thread[%x,%x] exit for page %d of <%s> mapper / ppn %x\n", |
---|
| 376 | __FUNCTION__, this->process->pid, this->trdid, page_id, name, ppm_page2ppn(page_xp) ); |
---|
[435] | 377 | #endif |
---|
[204] | 378 | |
---|
[683] | 379 | #if( DEBUG_MAPPER_GET_PAGE & 1) |
---|
[656] | 380 | if( DEBUG_MAPPER_GET_PAGE < cycle ) |
---|
| 381 | ppm_remote_display( local_cxy ); |
---|
| 382 | #endif |
---|
| 383 | |
---|
[606] | 384 | return page_xp; |
---|
[204] | 385 | |
---|
[657] | 386 | } // end mapper_get_page() |
---|
[204] | 387 | |
---|
[657] | 388 | ///////////////////////////////////////////////// |
---|
| 389 | xptr_t mapper_get_fat_page( xptr_t mapper_xp, |
---|
| 390 | uint32_t page_id ) |
---|
| 391 | { |
---|
| 392 | error_t error; |
---|
| 393 | |
---|
| 394 | thread_t * this = CURRENT_THREAD; |
---|
| 395 | |
---|
| 396 | // get mapper cluster and local pointer |
---|
| 397 | mapper_t * mapper_ptr = GET_PTR( mapper_xp ); |
---|
| 398 | cxy_t mapper_cxy = GET_CXY( mapper_xp ); |
---|
| 399 | |
---|
[672] | 400 | assert( __FUNCTION__, (hal_remote_lpt( XPTR( mapper_cxy , &mapper_ptr->inode ) ) == NULL ), |
---|
[657] | 401 | "should be used for the FAT mapper"); |
---|
| 402 | |
---|
| 403 | #if DEBUG_MAPPER_GET_FAT_PAGE |
---|
| 404 | uint32_t cycle = (uint32_t)hal_get_cycles(); |
---|
| 405 | if( DEBUG_MAPPER_GET_FAT_PAGE < cycle ) |
---|
| 406 | printk("\n[%s] thread[%x,%x] enter for page %d of FAT mapper / cycle %d\n", |
---|
| 407 | __FUNCTION__, this->process->pid, this->trdid, page_id, cycle ); |
---|
| 408 | #endif |
---|
| 409 | |
---|
| 410 | #if( DEBUG_MAPPER_GET_FAT_PAGE & 2 ) |
---|
| 411 | if( DEBUG_MAPPER_GET_FAT_PAGE < cycle ) |
---|
| 412 | ppm_remote_display( local_cxy ); |
---|
| 413 | #endif |
---|
| 414 | |
---|
| 415 | // check thread can yield |
---|
| 416 | thread_assert_can_yield( this , __FUNCTION__ ); |
---|
| 417 | |
---|
| 418 | // build extended pointer on mapper lock and mapper rt |
---|
| 419 | xptr_t lock_xp = XPTR( mapper_cxy , &mapper_ptr->lock ); |
---|
| 420 | xptr_t rt_xp = XPTR( mapper_cxy , &mapper_ptr->rt ); |
---|
| 421 | |
---|
| 422 | // take mapper lock in READ_MODE |
---|
| 423 | remote_rwlock_rd_acquire( lock_xp ); |
---|
| 424 | |
---|
| 425 | // search page in radix tree |
---|
| 426 | xptr_t page_xp = grdxt_remote_lookup( rt_xp , page_id ); |
---|
| 427 | |
---|
| 428 | // test mapper miss |
---|
| 429 | if( page_xp == XPTR_NULL ) // miss => handle it |
---|
| 430 | { |
---|
| 431 | // release the lock in READ_MODE and take it in WRITE_MODE |
---|
| 432 | remote_rwlock_rd_release( lock_xp ); |
---|
| 433 | remote_rwlock_wr_acquire( lock_xp ); |
---|
| 434 | |
---|
| 435 | // second test on missing page because the page status can be modified |
---|
| 436 | // by another thread, when passing from READ_MODE to WRITE_MODE. |
---|
| 437 | // from this point there is no concurrent accesses to mapper. |
---|
| 438 | page_xp = grdxt_remote_lookup( rt_xp , page_id ); |
---|
| 439 | |
---|
| 440 | if ( page_xp == XPTR_NULL ) // miss confirmed => handle it |
---|
| 441 | { |
---|
| 442 | error = mapper_handle_miss( mapper_xp, |
---|
| 443 | page_id, |
---|
| 444 | &page_xp ); |
---|
| 445 | if( error ) |
---|
| 446 | { |
---|
[683] | 447 | |
---|
| 448 | #if DEBUG_MAPPER_ERROR |
---|
| 449 | printk("\n[ERROR] in %s : thread[%x,%x] cannot handle mapper miss\n", |
---|
| 450 | __FUNCTION__ , this->process->pid, this->trdid ); |
---|
| 451 | remote_rwlock_wr_release( lock_xp ); |
---|
| 452 | #endif |
---|
[657] | 453 | return XPTR_NULL; |
---|
| 454 | } |
---|
| 455 | } |
---|
| 456 | |
---|
| 457 | #if (DEBUG_MAPPER_GET_FAT_PAGE & 1) |
---|
| 458 | if( DEBUG_MAPPER_GET_FAT_PAGE < cycle ) |
---|
| 459 | printk("\n[%s] thread[%x,%x] introduced missing page %d in FAT mapper / ppn %x\n", |
---|
| 460 | __FUNCTION__, this->process->pid, this->trdid, page_id, ppm_page2ppn(page_xp) ); |
---|
| 461 | #endif |
---|
| 462 | |
---|
| 463 | // release mapper lock from WRITE_MODE |
---|
| 464 | remote_rwlock_wr_release( lock_xp ); |
---|
| 465 | } |
---|
| 466 | else // hit |
---|
| 467 | { |
---|
| 468 | // release mapper lock from READ_MODE |
---|
| 469 | remote_rwlock_rd_release( lock_xp ); |
---|
| 470 | } |
---|
| 471 | |
---|
| 472 | #if DEBUG_MAPPER_GET_FAT_PAGE |
---|
| 473 | if( DEBUG_MAPPER_GET_FAT_PAGE < cycle ) |
---|
| 474 | printk("\n[%s] thread[%x,%x] exit for page %d of FAT mapper / ppn %x\n", |
---|
| 475 | __FUNCTION__, this->process->pid, this->trdid, page_id, ppm_page2ppn(page_xp) ); |
---|
| 476 | #endif |
---|
| 477 | |
---|
[683] | 478 | #if( DEBUG_MAPPER_GET_FAT_PAGE & 1) |
---|
[657] | 479 | if( DEBUG_MAPPER_GET_FAT_PAGE < cycle ) |
---|
| 480 | ppm_remote_display( local_cxy ); |
---|
| 481 | #endif |
---|
| 482 | |
---|
| 483 | return page_xp; |
---|
| 484 | |
---|
| 485 | } // end mapper_get_fat_page() |
---|
| 486 | |
---|
[635] | 487 | //////////////////////////////////////////////////// |
---|
| 488 | void mapper_remote_release_page( xptr_t mapper_xp, |
---|
| 489 | page_t * page ) |
---|
[1] | 490 | { |
---|
[635] | 491 | // get mapper cluster an local pointer |
---|
| 492 | cxy_t mapper_cxy = GET_CXY( mapper_xp ); |
---|
| 493 | mapper_t * mapper_ptr = GET_PTR( mapper_xp ); |
---|
[1] | 494 | |
---|
[606] | 495 | // build extended pointer on mapper lock |
---|
[635] | 496 | xptr_t lock_xp = XPTR( mapper_cxy , &mapper_ptr->lock ); |
---|
[606] | 497 | |
---|
[1] | 498 | // take mapper lock in WRITE_MODE |
---|
[635] | 499 | remote_rwlock_wr_acquire( lock_xp ); |
---|
[1] | 500 | |
---|
| 501 | // remove physical page from radix tree |
---|
[635] | 502 | grdxt_remote_remove( XPTR( mapper_cxy , &mapper_ptr->rt ) , page->index ); |
---|
[1] | 503 | |
---|
| 504 | // release mapper lock from WRITE_MODE |
---|
[635] | 505 | remote_rwlock_wr_release( lock_xp ); |
---|
[1] | 506 | |
---|
| 507 | // release page to PPM |
---|
[635] | 508 | ppm_remote_free_pages( mapper_cxy , page ); |
---|
| 509 | |
---|
[204] | 510 | } // end mapper_release_page() |
---|
| 511 | |
---|
[610] | 512 | /////////////////////////////////////////////// |
---|
| 513 | error_t mapper_move_user( xptr_t mapper_xp, |
---|
[313] | 514 | bool_t to_buffer, |
---|
| 515 | uint32_t file_offset, |
---|
| 516 | void * buffer, |
---|
| 517 | uint32_t size ) |
---|
[1] | 518 | { |
---|
[23] | 519 | uint32_t page_offset; // first byte to move to/from a mapper page |
---|
[628] | 520 | uint32_t page_bytes; // number of bytes to move to/from a mapper page |
---|
[606] | 521 | uint32_t page_id; // current mapper page index |
---|
[23] | 522 | uint32_t done; // number of moved bytes |
---|
[606] | 523 | xptr_t page_xp; // extended pointer on current mapper page descriptor |
---|
[330] | 524 | |
---|
[438] | 525 | #if DEBUG_MAPPER_MOVE_USER |
---|
[626] | 526 | uint32_t cycle = (uint32_t)hal_get_cycles(); |
---|
| 527 | thread_t * this = CURRENT_THREAD; |
---|
| 528 | cxy_t mapper_cxy = GET_CXY( mapper_xp ); |
---|
| 529 | mapper_t * mapper_ptr = GET_PTR( mapper_xp ); |
---|
| 530 | vfs_inode_t * inode_ptr = hal_remote_lpt( XPTR( mapper_cxy , &mapper_ptr->inode ) ); |
---|
| 531 | xptr_t inode_xp = XPTR( mapper_cxy , inode_ptr ); |
---|
| 532 | char name[CONFIG_VFS_MAX_NAME_LENGTH]; |
---|
| 533 | vfs_inode_get_name( inode_xp , name ); |
---|
[438] | 534 | if( DEBUG_MAPPER_MOVE_USER < cycle ) |
---|
[626] | 535 | { |
---|
| 536 | if( to_buffer ) |
---|
| 537 | printk("\n[%s] thread[%x,%x] : mapper(%s) -> buffer(%x) / bytes %d / cycle %d\n", |
---|
| 538 | __FUNCTION__, this->process->pid, this->trdid, name, buffer, size, cycle ); |
---|
| 539 | else |
---|
| 540 | printk("\n[%s] thread[%x,%x] : buffer(%x) -> mapper(%s) / bytes %d / cycle %d\n", |
---|
| 541 | __FUNCTION__, this->process->pid, this->trdid, buffer, name, size, cycle ); |
---|
| 542 | } |
---|
[435] | 543 | #endif |
---|
[1] | 544 | |
---|
[628] | 545 | // compute indexes of first and last bytes in file |
---|
[23] | 546 | uint32_t min_byte = file_offset; |
---|
[606] | 547 | uint32_t max_byte = file_offset + size - 1; |
---|
[1] | 548 | |
---|
[23] | 549 | // compute indexes of pages for first and last byte in mapper |
---|
[683] | 550 | uint32_t first = min_byte >> CONFIG_PPM_PAGE_ORDER; |
---|
| 551 | uint32_t last = max_byte >> CONFIG_PPM_PAGE_ORDER; |
---|
[1] | 552 | |
---|
[606] | 553 | #if (DEBUG_MAPPER_MOVE_USER & 1) |
---|
| 554 | if( DEBUG_MAPPER_MOVE_USER < cycle ) |
---|
[626] | 555 | printk("\n[%s] thread[%x,%x] : mapper(%x,%x) / first_page %d / last_page %d\n", |
---|
| 556 | __FUNCTION__, this->process->pid, this->trdid, mapper_cxy, mapper_ptr, first, last ); |
---|
[606] | 557 | #endif |
---|
| 558 | |
---|
[23] | 559 | done = 0; |
---|
[1] | 560 | |
---|
[23] | 561 | // loop on pages in mapper |
---|
[606] | 562 | for( page_id = first ; page_id <= last ; page_id++ ) |
---|
[1] | 563 | { |
---|
[183] | 564 | // compute page_offset |
---|
[606] | 565 | if( page_id == first ) page_offset = min_byte & CONFIG_PPM_PAGE_MASK; |
---|
| 566 | else page_offset = 0; |
---|
[1] | 567 | |
---|
[313] | 568 | // compute number of bytes in page |
---|
[628] | 569 | if ( first == last ) page_bytes = size; |
---|
| 570 | else if ( page_id == first ) page_bytes = CONFIG_PPM_PAGE_SIZE - page_offset; |
---|
| 571 | else if ( page_id == last ) page_bytes = (max_byte & CONFIG_PPM_PAGE_MASK) + 1; |
---|
| 572 | else page_bytes = CONFIG_PPM_PAGE_SIZE; |
---|
[1] | 573 | |
---|
[438] | 574 | #if (DEBUG_MAPPER_MOVE_USER & 1) |
---|
| 575 | if( DEBUG_MAPPER_MOVE_USER < cycle ) |
---|
[626] | 576 | printk("\n[%s] thread[%x,%x] : page_id %d / page_offset %d / bytes %d\n", |
---|
[628] | 577 | __FUNCTION__, this->process->pid, this->trdid, page_id , page_offset , page_bytes ); |
---|
[435] | 578 | #endif |
---|
[265] | 579 | |
---|
[628] | 580 | // get extended pointer on page descriptor in mapper |
---|
[657] | 581 | page_xp = mapper_get_page( mapper_xp , page_id ); |
---|
[1] | 582 | |
---|
[606] | 583 | if ( page_xp == XPTR_NULL ) return -1; |
---|
[1] | 584 | |
---|
[651] | 585 | // compute extended pointer on kernel mapper |
---|
[637] | 586 | xptr_t map_xp = ppm_page2base( page_xp ) + page_offset; |
---|
[626] | 587 | |
---|
[610] | 588 | #if (DEBUG_MAPPER_MOVE_USER & 1) |
---|
| 589 | if( DEBUG_MAPPER_MOVE_USER < cycle ) |
---|
[626] | 590 | printk("\n[%s] thread[%x,%x] : get buffer(%x,%x) in mapper\n", |
---|
[651] | 591 | __FUNCTION__, this->process->pid, this->trdid, GET_CXY(map_xp), GET_PTR(map_xp) ); |
---|
[610] | 592 | #endif |
---|
[626] | 593 | // compute pointer in user buffer |
---|
[606] | 594 | uint8_t * buf_ptr = (uint8_t *)buffer + done; |
---|
[1] | 595 | |
---|
| 596 | // move fragment |
---|
[330] | 597 | if( to_buffer ) |
---|
[1] | 598 | { |
---|
[637] | 599 | hal_copy_to_uspace( buf_ptr , map_xp , page_bytes ); |
---|
[626] | 600 | |
---|
| 601 | #if DEBUG_MAPPER_MOVE_USER & 1 |
---|
| 602 | if( DEBUG_MAPPER_MOVE_USER < cycle ) |
---|
| 603 | printk("\n[%s] thread[%x,%x] moved %d bytes / mapper %s (%x,%x) -> user buffer(%x,%x)\n", |
---|
[628] | 604 | __FUNCTION__, this->process->pid, this->trdid, page_bytes, |
---|
[637] | 605 | name, GET_CXY(map_xp), GET_PTR(map_xp), local_cxy, buf_ptr ); |
---|
[626] | 606 | #endif |
---|
| 607 | |
---|
[1] | 608 | } |
---|
[330] | 609 | else |
---|
[1] | 610 | { |
---|
[606] | 611 | ppm_page_do_dirty( page_xp ); |
---|
[637] | 612 | hal_copy_from_uspace( map_xp , buf_ptr , page_bytes ); |
---|
[626] | 613 | |
---|
| 614 | #if DEBUG_MAPPER_MOVE_USER & 1 |
---|
| 615 | if( DEBUG_MAPPER_MOVE_USER < cycle ) |
---|
| 616 | printk("\n[%s] thread[%x,%x] moved %d bytes / user buffer(%x,%x) -> mapper %s (%x,%x)\n", |
---|
[628] | 617 | __FUNCTION__, this->process->pid, this->trdid, page_bytes, |
---|
[637] | 618 | local_cxy, buf_ptr, name, GET_CXY(map_xp), GET_PTR(map_xp) ); |
---|
[657] | 619 | mapper_display_page( mapper_xp , page_id , 128 ); |
---|
[626] | 620 | #endif |
---|
| 621 | |
---|
[1] | 622 | } |
---|
| 623 | |
---|
[628] | 624 | done += page_bytes; |
---|
[1] | 625 | } |
---|
| 626 | |
---|
[438] | 627 | #if DEBUG_MAPPER_MOVE_USER |
---|
[626] | 628 | cycle = (uint32_t)hal_get_cycles(); |
---|
[438] | 629 | if( DEBUG_MAPPER_MOVE_USER < cycle ) |
---|
[626] | 630 | { |
---|
| 631 | if( to_buffer ) |
---|
| 632 | printk("\n[%s] thread[%x,%x] completed mapper(%s) -> buffer(%x) / cycle %d\n", |
---|
| 633 | __FUNCTION__, this->process->pid, this->trdid, name, buffer, cycle ); |
---|
| 634 | else |
---|
| 635 | printk("\n[%s] thread[%x,%x] completed buffer(%x) -> mapper(%s) / cycle %d\n", |
---|
| 636 | __FUNCTION__, this->process->pid, this->trdid, buffer, name, cycle ); |
---|
| 637 | } |
---|
[435] | 638 | #endif |
---|
[204] | 639 | |
---|
[1] | 640 | return 0; |
---|
| 641 | |
---|
[313] | 642 | } // end mapper_move_user() |
---|
[204] | 643 | |
---|
[313] | 644 | //////////////////////////////////////////////// |
---|
[606] | 645 | error_t mapper_move_kernel( xptr_t mapper_xp, |
---|
| 646 | bool_t to_buffer, |
---|
| 647 | uint32_t file_offset, |
---|
| 648 | xptr_t buffer_xp, |
---|
| 649 | uint32_t size ) |
---|
[313] | 650 | { |
---|
| 651 | uint32_t page_offset; // first byte to move to/from a mapper page |
---|
[628] | 652 | uint32_t page_bytes; // number of bytes to move to/from a mapper page |
---|
[606] | 653 | uint32_t page_id; // current mapper page index |
---|
[313] | 654 | uint32_t done; // number of moved bytes |
---|
[606] | 655 | xptr_t page_xp; // extended pointer on current mapper page descriptor |
---|
[313] | 656 | |
---|
| 657 | uint8_t * src_ptr; // source buffer local pointer |
---|
| 658 | cxy_t src_cxy; // source cluster |
---|
| 659 | uint8_t * dst_ptr; // destination buffer local pointer |
---|
| 660 | cxy_t dst_cxy; // destination cluster |
---|
[330] | 661 | |
---|
[406] | 662 | // get buffer cluster and local pointer |
---|
| 663 | cxy_t buffer_cxy = GET_CXY( buffer_xp ); |
---|
[606] | 664 | uint8_t * buffer_ptr = GET_PTR( buffer_xp ); |
---|
[313] | 665 | |
---|
[606] | 666 | // get mapper cluster |
---|
| 667 | cxy_t mapper_cxy = GET_CXY( mapper_xp ); |
---|
| 668 | |
---|
[438] | 669 | #if DEBUG_MAPPER_MOVE_KERNEL |
---|
[625] | 670 | char name[CONFIG_VFS_MAX_NAME_LENGTH]; |
---|
| 671 | uint32_t cycle = (uint32_t)hal_get_cycles(); |
---|
| 672 | thread_t * this = CURRENT_THREAD; |
---|
| 673 | mapper_t * mapper = GET_PTR( mapper_xp ); |
---|
| 674 | vfs_inode_t * inode = hal_remote_lpt( XPTR( mapper_cxy , &mapper->inode ) ); |
---|
| 675 | vfs_inode_get_name( XPTR( mapper_cxy , inode ) , name ); |
---|
[438] | 676 | if( DEBUG_MAPPER_MOVE_KERNEL < cycle ) |
---|
[625] | 677 | printk("\n[%s] thread[%x,%x] enter / %d bytes / offset %d / mapper <%s> / cycle %d\n", |
---|
| 678 | __FUNCTION__, this->process->pid, this->trdid, size, file_offset, name, cycle ); |
---|
[435] | 679 | #endif |
---|
[406] | 680 | |
---|
[313] | 681 | // compute offsets of first and last bytes in file |
---|
| 682 | uint32_t min_byte = file_offset; |
---|
| 683 | uint32_t max_byte = file_offset + size -1; |
---|
| 684 | |
---|
| 685 | // compute indexes for first and last pages in mapper |
---|
[683] | 686 | uint32_t first = min_byte >> CONFIG_PPM_PAGE_ORDER; |
---|
| 687 | uint32_t last = max_byte >> CONFIG_PPM_PAGE_ORDER; |
---|
[313] | 688 | |
---|
| 689 | // compute source and destination clusters |
---|
| 690 | if( to_buffer ) |
---|
| 691 | { |
---|
| 692 | dst_cxy = buffer_cxy; |
---|
[606] | 693 | src_cxy = mapper_cxy; |
---|
[313] | 694 | } |
---|
| 695 | else |
---|
| 696 | { |
---|
| 697 | src_cxy = buffer_cxy; |
---|
[606] | 698 | dst_cxy = mapper_cxy; |
---|
[313] | 699 | } |
---|
| 700 | |
---|
| 701 | done = 0; |
---|
| 702 | |
---|
| 703 | // loop on pages in mapper |
---|
[606] | 704 | for( page_id = first ; page_id <= last ; page_id++ ) |
---|
[313] | 705 | { |
---|
| 706 | // compute page_offset |
---|
[606] | 707 | if( page_id == first ) page_offset = min_byte & CONFIG_PPM_PAGE_MASK; |
---|
| 708 | else page_offset = 0; |
---|
[313] | 709 | |
---|
| 710 | // compute number of bytes to move in page |
---|
[628] | 711 | if ( first == last ) page_bytes = size; |
---|
| 712 | else if ( page_id == first ) page_bytes = CONFIG_PPM_PAGE_SIZE - page_offset; |
---|
| 713 | else if ( page_id == last ) page_bytes = (max_byte & CONFIG_PPM_PAGE_MASK) + 1; |
---|
| 714 | else page_bytes = CONFIG_PPM_PAGE_SIZE; |
---|
[313] | 715 | |
---|
[606] | 716 | // get extended pointer on page descriptor |
---|
[657] | 717 | page_xp = mapper_get_page( mapper_xp , page_id ); |
---|
[313] | 718 | |
---|
[606] | 719 | if ( page_xp == XPTR_NULL ) return -1; |
---|
[313] | 720 | |
---|
[315] | 721 | // get page base address |
---|
[606] | 722 | xptr_t base_xp = ppm_page2base( page_xp ); |
---|
[367] | 723 | uint8_t * base_ptr = (uint8_t *)GET_PTR( base_xp ); |
---|
[330] | 724 | |
---|
[313] | 725 | // compute source and destination pointers |
---|
| 726 | if( to_buffer ) |
---|
| 727 | { |
---|
[315] | 728 | dst_ptr = buffer_ptr + done; |
---|
[367] | 729 | src_ptr = base_ptr + page_offset; |
---|
[313] | 730 | } |
---|
| 731 | else |
---|
| 732 | { |
---|
[315] | 733 | src_ptr = buffer_ptr + done; |
---|
[367] | 734 | dst_ptr = base_ptr + page_offset; |
---|
[313] | 735 | |
---|
[606] | 736 | ppm_page_do_dirty( page_xp ); |
---|
[313] | 737 | } |
---|
| 738 | |
---|
[610] | 739 | #if (DEBUG_MAPPER_MOVE_KERNEL & 1) |
---|
| 740 | if( DEBUG_MAPPER_MOVE_KERNEL < cycle ) |
---|
[625] | 741 | { |
---|
| 742 | if( to_buffer ) |
---|
[656] | 743 | printk("\n[%s] mapper <%s> page %d => buffer (%x,%x) / %d bytes\n", |
---|
[628] | 744 | __FUNCTION__, name, page_id, dst_cxy, dst_ptr, page_bytes ); |
---|
[625] | 745 | else |
---|
[656] | 746 | printk("\n[%s] buffer (%x,%x) => mapper <%s> page %d / %d bytes\n", |
---|
[628] | 747 | __FUNCTION__, src_cxy, src_ptr, name, page_id, page_bytes ); |
---|
[625] | 748 | } |
---|
[610] | 749 | #endif |
---|
| 750 | |
---|
[313] | 751 | // move fragment |
---|
[628] | 752 | hal_remote_memcpy( XPTR( dst_cxy , dst_ptr ), XPTR( src_cxy , src_ptr ), page_bytes ); |
---|
[330] | 753 | |
---|
[628] | 754 | done += page_bytes; |
---|
[313] | 755 | } |
---|
| 756 | |
---|
[438] | 757 | #if DEBUG_MAPPER_MOVE_KERNEL |
---|
[625] | 758 | cycle = (uint32_t)hal_get_cycles(); |
---|
[438] | 759 | if( DEBUG_MAPPER_MOVE_KERNEL < cycle ) |
---|
[656] | 760 | printk("\n[%s] thread[%x,%x] exit / mapper <%s> / buffer (%x,%x) / cycle %d\n", |
---|
| 761 | __FUNCTION__, this->process->pid, this->trdid, name, buffer_cxy, buffer_ptr, cycle ); |
---|
[435] | 762 | #endif |
---|
[313] | 763 | |
---|
| 764 | return 0; |
---|
| 765 | |
---|
[406] | 766 | } // end mapper_move_kernel() |
---|
[313] | 767 | |
---|
[606] | 768 | /////////////////////////////////////////////////// |
---|
| 769 | error_t mapper_remote_get_32( xptr_t mapper_xp, |
---|
[628] | 770 | uint32_t page_id, |
---|
[606] | 771 | uint32_t word_id, |
---|
[628] | 772 | uint32_t * value ) |
---|
[606] | 773 | { |
---|
| 774 | xptr_t page_xp; // extended pointer on searched page descriptor |
---|
| 775 | xptr_t base_xp; // extended pointer on searched page base |
---|
| 776 | |
---|
| 777 | // get page containing the searched word |
---|
[657] | 778 | page_xp = mapper_get_page( mapper_xp , page_id ); |
---|
[606] | 779 | |
---|
| 780 | if( page_xp == XPTR_NULL ) return -1; |
---|
| 781 | |
---|
| 782 | // get page base |
---|
| 783 | base_xp = ppm_page2base( page_xp ); |
---|
| 784 | |
---|
| 785 | // get the value from mapper |
---|
[628] | 786 | *value = hal_remote_l32( base_xp + (word_id<<2) ); |
---|
[606] | 787 | |
---|
| 788 | return 0; |
---|
| 789 | |
---|
| 790 | } // end mapper_remote_get_32() |
---|
| 791 | |
---|
| 792 | /////////////////////////////////////////////////// |
---|
| 793 | error_t mapper_remote_set_32( xptr_t mapper_xp, |
---|
[628] | 794 | uint32_t page_id, |
---|
[606] | 795 | uint32_t word_id, |
---|
| 796 | uint32_t value ) |
---|
| 797 | { |
---|
| 798 | xptr_t page_xp; // extended pointer on searched page descriptor |
---|
| 799 | xptr_t base_xp; // extended pointer on searched page base |
---|
| 800 | |
---|
| 801 | // get page containing the searched word |
---|
[657] | 802 | page_xp = mapper_get_page( mapper_xp , page_id ); |
---|
[606] | 803 | |
---|
| 804 | if( page_xp == XPTR_NULL ) return -1; |
---|
| 805 | |
---|
| 806 | // get page base |
---|
| 807 | base_xp = ppm_page2base( page_xp ); |
---|
| 808 | |
---|
| 809 | // set value to mapper |
---|
[628] | 810 | hal_remote_s32( (base_xp + (word_id << 2)) , value ); |
---|
[606] | 811 | |
---|
[628] | 812 | // set the dirty flag in page descriptor |
---|
[606] | 813 | ppm_page_do_dirty( page_xp ); |
---|
| 814 | |
---|
| 815 | return 0; |
---|
| 816 | |
---|
| 817 | } // end mapper_remote_set_32() |
---|
| 818 | |
---|
[657] | 819 | //////////////////////////////////////// |
---|
| 820 | error_t mapper_sync( xptr_t mapper_xp ) |
---|
[623] | 821 | { |
---|
[657] | 822 | uint32_t found_key; // unused, required by grdxt_remote_get_first() |
---|
[623] | 823 | error_t error; |
---|
| 824 | |
---|
[657] | 825 | // get mapper cluster and local pointer |
---|
| 826 | mapper_t * mapper_ptr = GET_PTR( mapper_xp ); |
---|
| 827 | cxy_t mapper_cxy = GET_CXY( mapper_xp ); |
---|
| 828 | |
---|
[623] | 829 | #if DEBUG_MAPPER_SYNC |
---|
| 830 | thread_t * this = CURRENT_THREAD; |
---|
| 831 | uint32_t cycle = (uint32_t)hal_get_cycles(); |
---|
| 832 | char name[CONFIG_VFS_MAX_NAME_LENGTH]; |
---|
[657] | 833 | vfs_inode_get_name( XPTR( mapper_cxy , &mapper_ptr->inode ) , name ); |
---|
[623] | 834 | #endif |
---|
| 835 | |
---|
[657] | 836 | // build extended pointer on radix tree |
---|
| 837 | xptr_t rt_xp = XPTR( mapper_cxy , &mapper_ptr->rt ); |
---|
[623] | 838 | |
---|
| 839 | // initialise loop variable |
---|
[657] | 840 | uint32_t start_key = 0; |
---|
[623] | 841 | |
---|
| 842 | // scan radix-tree until last page found |
---|
| 843 | while( 1 ) |
---|
| 844 | { |
---|
| 845 | // get page descriptor from radix tree |
---|
[657] | 846 | xptr_t page_xp = grdxt_remote_get_first( rt_xp , start_key , &found_key ); |
---|
[623] | 847 | |
---|
[657] | 848 | page_t * page_ptr = GET_PTR( page_xp ); |
---|
[623] | 849 | |
---|
[657] | 850 | // exit loop when last page found |
---|
| 851 | if( page_ptr == NULL ) break; |
---|
[623] | 852 | |
---|
[657] | 853 | // get page flags & index fields |
---|
| 854 | uint32_t flags = hal_remote_l32( XPTR( mapper_cxy , &page_ptr->flags ) ); |
---|
| 855 | uint32_t index = hal_remote_l32( XPTR( mapper_cxy , &page_ptr->index ) ); |
---|
[623] | 856 | |
---|
| 857 | // synchronize page if dirty |
---|
[657] | 858 | if( flags & PG_DIRTY ) |
---|
[623] | 859 | { |
---|
| 860 | |
---|
| 861 | #if DEBUG_MAPPER_SYNC |
---|
| 862 | if( cycle > DEBUG_MAPPER_SYNC ) |
---|
[626] | 863 | printk("\n[%s] thread[%x,%x] synchonise page %d of <%s> to IOC device\n", |
---|
[657] | 864 | __FUNCTION__, this->process->pid, this->trdid, page_ptr->index, name ); |
---|
[623] | 865 | #endif |
---|
| 866 | // copy page to file system |
---|
| 867 | error = vfs_fs_move_page( page_xp , IOC_WRITE ); |
---|
| 868 | |
---|
| 869 | if( error ) |
---|
| 870 | { |
---|
[683] | 871 | |
---|
| 872 | #if DEBUG_MAPPER_SYNC |
---|
| 873 | printk("\n[ERROR] in %s : cannot synchonize dirty page %d\n", |
---|
| 874 | __FUNCTION__, page_ptr->index ); |
---|
| 875 | #endif |
---|
[623] | 876 | return -1; |
---|
| 877 | } |
---|
| 878 | |
---|
| 879 | // remove page from PPM dirty list |
---|
| 880 | ppm_page_undo_dirty( page_xp ); |
---|
| 881 | } |
---|
| 882 | else |
---|
| 883 | { |
---|
| 884 | |
---|
| 885 | #if DEBUG_MAPPER_SYNC |
---|
| 886 | if( cycle > DEBUG_MAPPER_SYNC ) |
---|
| 887 | printk("\n[%s] thread[%x,%x] skip page %d for <%s>\n", |
---|
[657] | 888 | __FUNCTION__, this->process->pid, this->trdid, page_ptr->index, name ); |
---|
[623] | 889 | #endif |
---|
| 890 | } |
---|
| 891 | |
---|
| 892 | // update loop variable |
---|
[657] | 893 | start_key = index + 1; |
---|
[623] | 894 | } // end while |
---|
| 895 | |
---|
| 896 | return 0; |
---|
| 897 | |
---|
| 898 | } // end mapper_sync() |
---|
| 899 | |
---|
[656] | 900 | /////////////////////////////////////////////// |
---|
| 901 | void mapper_display_page( xptr_t mapper_xp, |
---|
[657] | 902 | uint32_t page_id, |
---|
[656] | 903 | uint32_t nbytes ) |
---|
[611] | 904 | { |
---|
[614] | 905 | char buffer[4096]; // local buffer |
---|
| 906 | uint32_t line; // line index |
---|
| 907 | uint32_t word; // word index |
---|
| 908 | |
---|
| 909 | char name[CONFIG_VFS_MAX_NAME_LENGTH]; |
---|
[606] | 910 | |
---|
[672] | 911 | assert( __FUNCTION__, (nbytes <= 4096) , "nbytes cannot be larger than 4096"); |
---|
| 912 | assert( __FUNCTION__, (mapper_xp != XPTR_NULL) , "mapper_xp argument cannot be null"); |
---|
[611] | 913 | |
---|
[656] | 914 | // get mapper cluster and local pointer |
---|
| 915 | cxy_t mapper_cxy = GET_CXY( mapper_xp ); |
---|
| 916 | mapper_t * mapper_ptr = GET_PTR( mapper_xp ); |
---|
[611] | 917 | |
---|
[657] | 918 | // get extended pointer on page descriptor |
---|
| 919 | xptr_t page_xp = mapper_get_page( mapper_xp , page_id ); |
---|
| 920 | |
---|
| 921 | // get page cluster and local pointer |
---|
[656] | 922 | cxy_t page_cxy = GET_CXY( page_xp ); |
---|
| 923 | page_t * page_ptr = GET_PTR( page_xp ); |
---|
[614] | 924 | |
---|
[656] | 925 | // get page_id and mapper from page descriptor |
---|
[657] | 926 | uint32_t index = hal_remote_l32( XPTR( page_cxy , &page_ptr->index ) ); |
---|
[656] | 927 | mapper_t * mapper = hal_remote_lpt( XPTR( page_cxy , &page_ptr->mapper ) ); |
---|
| 928 | |
---|
[672] | 929 | assert( __FUNCTION__, (mapper_cxy == page_cxy ) , "mapper and page must be in same cluster"); |
---|
| 930 | assert( __FUNCTION__, (mapper_ptr == mapper ) , "unconsistent mapper field in page descriptor"); |
---|
| 931 | assert( __FUNCTION__, (page_id == index ) , "unconsistent index field in page descriptor"); |
---|
[656] | 932 | |
---|
[614] | 933 | // get inode |
---|
[656] | 934 | vfs_inode_t * inode_ptr = hal_remote_lpt( XPTR( mapper_cxy , &mapper_ptr->inode ) ); |
---|
[614] | 935 | |
---|
| 936 | // get inode name |
---|
[656] | 937 | if( inode_ptr == NULL ) strcpy( name , "FAT" ); |
---|
[614] | 938 | else vfs_inode_get_name( XPTR( mapper_cxy , inode_ptr ) , name ); |
---|
| 939 | |
---|
[611] | 940 | // get extended pointer on page base |
---|
[656] | 941 | xptr_t base_xp = ppm_page2base( page_xp ); |
---|
[611] | 942 | |
---|
| 943 | // copy remote page to local buffer |
---|
| 944 | hal_remote_memcpy( XPTR( local_cxy , buffer ) , base_xp , nbytes ); |
---|
| 945 | |
---|
[656] | 946 | // display header |
---|
| 947 | uint32_t * tabi = (uint32_t *)buffer; |
---|
| 948 | printk("\n***** mapper <%s> / page_id %d / cxy %x / mapper %x / buffer %x\n", |
---|
| 949 | name, page_id, mapper_cxy, mapper_ptr, GET_PTR( base_xp ) ); |
---|
| 950 | |
---|
[611] | 951 | // display 8 words per line |
---|
| 952 | for( line = 0 ; line < (nbytes >> 5) ; line++ ) |
---|
| 953 | { |
---|
[625] | 954 | printk("%X : ", line << 5 ); |
---|
[614] | 955 | for( word = 0 ; word < 8 ; word++ ) printk("%X ", tabi[(line<<3) + word] ); |
---|
[611] | 956 | printk("\n"); |
---|
| 957 | } |
---|
| 958 | |
---|
[656] | 959 | } // end mapper_display_page() |
---|
[611] | 960 | |
---|
| 961 | |
---|