ttb_base 切换出问题

true_casey

小弟最近在写一个小小小小的ARM RTOS，以前写过一个小小小小的 X86 OS caseyOS, 现在想将 caseyOS裁剪移植到开发板 TQ2440上
是这样的，我实现将 内核的3G - 4G-1地址全部只读共享给用户进程，因此在创建进程的时候必须要 copy_kernel_page_tbls

1. 
   
2. #define INIT_L1_BASE        (0x30100000)            /* 16K */
   
3.     #define INIT_L2_BASE        (0x30104000)            /* 64k */
   
4.    
   
5.     #define KERNEL_IMG_SIZE     (0x20000)               /* 128 K */  
   
6.     #define KERNEL_CODE_START   (0xC0000000)            /* 3G start */
   
7.    
   
8.     #define TTB_BASE            (0x30000000)         
   
9.     #define PAGE_DIR            (TTB_BASE)         
   
10.     #define TTB_FULL_SIZE       (0x4000)                /* 16K */   
    
11.     #define PAGE_TABLE          (TTB_BASE+TTB_FULL_SIZE)                 
    
12.    
    
13.     #define PAGE_DIR_SIZE       (0x4000)                /* 16k */
    
14.     #define PAGE_TBL_SIZE       (0x10000)               /* 64K */
    
15.    
    
16.     void copy_kernel_page_tbls (unsigned dest_ttb,unsigned vaddr,unsigned size)
    
17.     {
    
18.         if ((size & 0xFFFFF) || (vaddr & 0xFFFFF))                            /* 1M alignment */
    
19.             panic ( "trying to copy page tables with non-1M alignment !\n" );
    
20.         volatile unsigned *_from_page_dir,*_to_page_dir;
    
21.    
    
22.         _from_page_dir = (volatile unsigned *)(TTB_BASE);
    
23.         _to_page_dir = (volatile unsigned *)dest_ttb;
    
24.    
    
25.         unsigned l1_idx;
    
26.         unsigned i = 0,j = 0,k = 0,page;
    
27.         volatile unsigned *_to_page_tbl,*_from_page_tbl;
    
28.    
    
29.         for (k = 0 ,size >>= 20 ; k < size ; k ++,vaddr += 0x100000 )
    
30.         {
    
31.             l1_idx = vaddr>>20;
    
32.             if ( !(_from_page_dir[l1_idx] & ~0x3FF))
    
33.                 continue;
    
34.             if ( !(_to_page_dir[l1_idx] & ~0x3FF) ) {                       /* if dest page dir unit is empty */
    
35.                 i = l1_idx & ~3;
    
36.                 if ((_to_page_dir[i+0] & ~0x3FF) || (_to_page_dir[i+1] & ~0x3FF)
    
37.                 ||  (_to_page_dir[i+2] & ~0x3FF) || (_to_page_dir[i+3] & ~0x3FF) )
    
38.                 {
    
39.                     panic ( "page dir corrupts with l1_idx %d !\n",l1_idx );
    
40.                 }
    
41.                 if (!(page = find_free_page ()))
    
42.                     panic ( "no more free page !\n" );                      /* alloc a page page dir*/
    
43.                 wordset ((void*)page,AP_FAULT_ALL|CB|TTB1_SPG,0x1000);      /* set all be fault  */
    
44.    
    
45.                 _to_page_dir[i+0] = (page + 0x000)|DOMAIN_SYS|TTB0_COARSE;  /* small page 1st 1KB */
    
46.                 _to_page_dir[i+1] = (page + 0x400)|DOMAIN_SYS|TTB0_COARSE;  /* small page 2nd 1KB */
    
47.                 _to_page_dir[i+2] = (page + 0x800)|DOMAIN_SYS|TTB0_COARSE;  /* small page 3rd 1KB */
    
48.                 _to_page_dir[i+3] = (page + 0xC00)|DOMAIN_SYS|TTB0_COARSE;  /* small page 4th 1KB */
    
49.             }
    
50.             _from_page_tbl = (volatile unsigned*)(_from_page_dir[l1_idx] & ~(0x3FF));
    
51.             _to_page_tbl = (volatile unsigned*)(_to_page_dir[l1_idx] & ~(0x3FF));
    
52.    
    
53.             /* continue copying .... */
    
54.             for (j = 0 ; j < 256 ; j++ ) {                                  /* 256 * 4K */
    
55.                 if (_from_page_tbl[j] & ~0xFFF)
    
56.                     _to_page_tbl[j] = _from_page_tbl[j];                    /* FIXME : change attribute */
    
57.             }
    
58.         }
    
59.     }

复制代码

我是这么调用的，在 return_to_usr_mode 之前就分配好 text code 内存页，page dir 16K，然后开始拷贝内核页表

1.   copy_kernel_page_tbls (INIT_L1_BASE,KERNEL_CODE_START,1<<30);           /* 1G size */

复制代码

然后时钟 handler 是这样的

1.    
   
2. extern unsigned long __ticks;
   
3.    
   
4.     #define __DEBUG__
   
5.    
   
6.     static   
   
7.     void schedlue ( void )
   
8.     {
   
9.             sync_dcaches ();
   
10.             invalidate_icaches ();
    
11.             invalidate_dcaches ();
    
12.    
    
13.             invalidate_tlbs();                                 
    
14.             set_ttb_base(current_p->ttb_base);                        
    
15.     }
    
16.         
    
17.     void __do_timer0 (void)
    
18.     {
    
19.         static unsigned i = 0;
    
20.         ++ i;
    
21.         /* just 2 tasks */
    
22.             current_p = task_st[i & 1];                       
    
23.             __ticks ++;
    
24.    
    
25.             schedule ();
    
26.     }

复制代码

>>>> 请高手指点下，哪里出错了....
Any help appreciated !

独上阳台

新人，学习下