Kernel/x86 - Structure for watchpoints (not used)
[tpg/acess2.git] / KernelLand / Kernel / arch / x86 / mm_virt.c
index acfeaa7..aec6c60 100644 (file)
 #include <arch_int.h>
 #include <semaphore.h>
 
+#include "include/vmem_layout.h"
+
 #define TRACE_MAPS     0
 
+#define        KWATCH_BUCKETS  512
+
 #define TAB    22
 
-#define WORKER_STACKS          0x00100000      // Thread0 Only!
-#define        WORKER_STACK_SIZE       MM_KERNEL_STACK_SIZE
-#define WORKER_STACKS_END      0xB0000000
-#define        NUM_WORKER_STACKS       ((WORKER_STACKS_END-WORKER_STACKS)/WORKER_STACK_SIZE)
-
-#define PAE_PAGE_TABLE_ADDR    0xFC000000      // 16 MiB
-#define PAE_PAGE_DIR_ADDR      0xFCFC0000      // 16 KiB
-#define PAE_PAGE_PDPT_ADDR     0xFCFC3F00      // 32 bytes
-#define PAE_TMP_PDPT_ADDR      0xFCFC3F20      // 32 bytes
-#define PAE_TMP_DIR_ADDR       0xFCFE0000      // 16 KiB
-#define PAE_TMP_TABLE_ADDR     0xFD000000      // 16 MiB
-
-#define PAGE_TABLE_ADDR        0xFC000000
-#define PAGE_DIR_ADDR  0xFC3F0000
-#define PAGE_CR3_ADDR  0xFC3F0FC0
-#define TMP_CR3_ADDR   0xFC3F0FC4      // Part of core instead of temp
-#define TMP_DIR_ADDR   0xFC3F1000      // Same
-#define TMP_TABLE_ADDR 0xFC400000
-
-#define HW_MAP_ADDR            0xFE000000
-#define        HW_MAP_MAX              0xFFEF0000
-#define        NUM_HW_PAGES    ((HW_MAP_MAX-HW_MAP_ADDR)/0x1000)
-#define        TEMP_MAP_ADDR   0xFFEF0000      // Allows 16 "temp" pages
-#define        NUM_TEMP_PAGES  16
-#define LAST_BLOCK_ADDR        0xFFFF0000      // Free space for kernel provided user code/ *(-1) protection
-
-#define        PF_PRESENT      0x1
-#define        PF_WRITE        0x2
-#define        PF_USER         0x4
-#define PF_GLOBAL      0x80
-#define        PF_COW          0x200
-#define        PF_NOPAGE       0x400
+#define        PF_PRESENT      0x01
+#define        PF_WRITE        0x02
+#define        PF_USER         0x04
+#define PF_PAGEWT      0x08    // Page-level write through
+#define PF_PAGECD      0x10    // Page-level cache disable
+#define PF_ACCESSED    0x20
+#define PF_DIRTY       0x40
+#define PF_PAT         0x80    // ?
+#define PF_GLOBAL      0x100   // Global Page
+#define        PF_COW          0x200   // [ 9] Ignored - Copy-on-write
+#define        PF_NOPAGE       0x400   // [10] Ignored - Disable page-out
+#define PF_WATCHED     0x800   // [11] Ignored - Watchpointing enabled
 
 #define INVLPG(addr)   __asm__ __volatile__ ("invlpg (%0)"::"r"(addr))
 
@@ -72,14 +56,23 @@ typedef Uint32      tTabEnt;
 // === IMPORTS ===
 extern tPage   _UsertextEnd;
 extern tPage   _UsertextBase;
+extern tPage   gKernelEnd;     // defined as page aligned
 extern Uint32  gaInitPageDir[1024];
 extern Uint32  gaInitPageTable[1024];
 extern void    Threads_SegFault(tVAddr Addr);
 
+typedef struct sWatchpoint
+{
+       struct sWatchpoint      *Next;
+       Uint    PageNum;
+       Uint8   Bitmap[PAGE_SIZE/4/8];
+} tWatchpoint;
+
 // === PROTOTYPES ===
 void   MM_PreinitVirtual(void);
 void   MM_InstallVirtual(void);
 void   MM_PageFault(tVAddr Addr, Uint ErrorCode, tRegs *Regs);
+void   MM_DumpTables_Print(tVAddr Start, Uint32 Orig, size_t Size, void *Node);
 //void MM_DumpTables(tVAddr Start, tVAddr End);
 //void MM_ClearUser(void);
 tPAddr MM_DuplicatePage(tVAddr VAddr);
@@ -114,6 +107,7 @@ struct sPageInfo {
 // - Zero page
 tShortSpinlock glMM_ZeroPage;
 tPAddr giMM_ZeroPage;
+tWatchpoint    *gapKernelWatchpoints[KWATCH_BUCKETS];
 
 // === CODE ===
 /**
@@ -134,10 +128,15 @@ void MM_PreinitVirtual(void)
  */
 void MM_InstallVirtual(void)
 {
+       // Don't bother referencing, as it'a in the kernel area
+       //MM_RefPhys( gaInitPageDir[ PAGE_TABLE_ADDR >> 22 ] );
        // --- Pre-Allocate kernel tables
        for( int i = KERNEL_BASE>>22; i < 1024; i ++ )
        {
-               if( gaPageDir[ i ] )    continue;
+               if( gaPageDir[ i ] ) {
+               //      MM_RefPhys( gaPageDir[ i ] & ~0xFFF );
+                       continue;
+               }       
                // Skip stack tables, they are process unique
                if( i > MM_KERNEL_STACKS >> 22 && i < MM_KERNEL_STACKS_END >> 22) {
                        gaPageDir[ i ] = 0;
@@ -156,7 +155,17 @@ void MM_InstallVirtual(void)
        {
                MM_SetFlags( page, 0, MM_PFLAG_KERNEL );
        }
-       
+
+       // Unmap the area between end of kernel image and the heap
+       // DISABLED: Assumptions in main.c
+       #if 0
+       for( tPage *page = &gKernelEnd; page < (tPage*)(KERNEL_BASE+4*1024*1024); page ++ )
+       {
+               gaPageTable[ (tVAddr)page / PAGE_SIZE ] = 0;
+               //MM_Deallocate(page);
+       }
+       #endif
+
        *gpTmpCR3 = 0;
 }
 
@@ -174,26 +183,27 @@ void MM_FinishVirtualInit(void)
  */
 void MM_PageFault(tVAddr Addr, Uint ErrorCode, tRegs *Regs)
 {
+       Uint32  *pde = &gaPageDir[Addr>>22];
+       Uint32  *pte = &gaPageTable[Addr>>12];
        //ENTER("xAddr bErrorCode", Addr, ErrorCode);
        
        // -- Check for COW --
-       if( gaPageDir  [Addr>>22] & PF_PRESENT  && gaPageTable[Addr>>12] & PF_PRESENT
-        && gaPageTable[Addr>>12] & PF_COW )
+       if( (*pde & PF_PRESENT) && (*pte & PF_PRESENT) && (*pte & PF_COW) )
        {
                tPAddr  paddr;
                __asm__ __volatile__ ("sti");
-               if(MM_GetRefCount( gaPageTable[Addr>>12] & ~0xFFF ) == 1)
+               if( MM_GetRefCount( *pte & ~0xFFF ) == 1 )
                {
-                       gaPageTable[Addr>>12] &= ~PF_COW;
-                       gaPageTable[Addr>>12] |= PF_PRESENT|PF_WRITE;
+                       *pte &= ~PF_COW;
+                       *pte |= PF_PRESENT|PF_WRITE;
                }
                else
                {
                        //Log("MM_PageFault: COW - MM_DuplicatePage(0x%x)", Addr);
                        paddr = MM_DuplicatePage( Addr );
-                       MM_DerefPhys( gaPageTable[Addr>>12] & ~0xFFF );
-                       gaPageTable[Addr>>12] &= PF_USER;
-                       gaPageTable[Addr>>12] |= paddr|PF_PRESENT|PF_WRITE;
+                       MM_DerefPhys( *pte & ~0xFFF );
+                       *pte &= PF_USER;
+                       *pte |= paddr|PF_PRESENT|PF_WRITE;
                }
                
 //             Log_Debug("MMVirt", "COW for %p (%P)", Addr, gaPageTable[Addr>>12]);
@@ -202,6 +212,38 @@ void MM_PageFault(tVAddr Addr, Uint ErrorCode, tRegs *Regs)
                return;
        }
 
+       // --- Check for write to controlled area ---
+       // TODO: Catch user access
+       if( (*pde & PF_PRESENT) && (*pte & PF_PRESENT) && !(*pte & PF_WRITE) && (*pte & PF_WATCHED) )
+       {
+               Uint    page = Addr >> 12;
+               Uint    ofs = Addr & 0xFFF;
+               // Watchpoints are active for this page.
+               // > Locate watchpoint bitmap for page (dword granuality)
+               tWatchpoint     *wp = ( Addr >= KERNEL_BASE ? gapKernelWatchpoints[page%KWATCH_BUCKETS] : NULL);
+               while( wp && wp->PageNum == page )
+                       wp = wp->Next;
+               if( !wp )
+               {
+                       Log_Warning("MMVirt", "PF_WATCHED set on %p but no watchpoint info avaliable", Addr);
+               }
+               else
+               {
+                       // > If bit set, log/raise
+                       if( wp->Bitmap[ (ofs/4)/8 ] & (1 << (ofs/4)%8) )
+                       {
+                               Log_Error("DEBUG", "Watchpoint %p written by %x:%p",
+                                       Addr, Regs->cs, Regs->eip);
+                       }
+                       Regs->eflags |= 1<<8;
+                       //Proc_GetCurThread()->Proc.WPPage = Addr;
+               }
+               // > Clear write protection, set tracing
+               *pte |= PF_WRITE;
+               INVLPG( Addr & ~0xFFF );
+               return ;
+       }
+
        // Disable instruction tracing  
        __ASM__("pushf; andw $0xFEFF, 0(%esp); popf");
        Proc_GetCurThread()->bInstrTrace = 0;
@@ -264,6 +306,37 @@ void MM_PageFault(tVAddr Addr, Uint ErrorCode, tRegs *Regs)
        Panic("Page Fault at 0x%x (Accessed 0x%x)", Regs->eip, Addr);
 }
 
+void MM_DumpTables_Print(tVAddr Start, Uint32 Orig, size_t Size, void *Node)
+{
+       if( (Orig & ~(PAGE_SIZE-1)) == giMM_ZeroPage )
+       {
+               Log( "0x%08x => ZERO + 0x%08x (%s%s%s%s%s) %p",
+                       Start,
+                       Size,
+                       (Orig & PF_NOPAGE ? "P" : "-"),
+                       (Orig & PF_COW ? "C" : "-"),
+                       (Orig & PF_GLOBAL ? "G" : "-"),
+                       (Orig & PF_USER ? "U" : "-"),
+                       (Orig & PF_WRITE ? "W" : "-"),
+                       Node
+                       );
+       }
+       else
+       {
+               Log(" 0x%08x => 0x%08x + 0x%08x (%s%s%s%s%s) %p",
+                       Start,
+                       Orig & ~0xFFF,
+                       Size,
+                       (Orig & PF_NOPAGE ? "P" : "-"),
+                       (Orig & PF_COW ? "C" : "-"),
+                       (Orig & PF_GLOBAL ? "G" : "-"),
+                       (Orig & PF_USER ? "U" : "-"),
+                       (Orig & PF_WRITE ? "W" : "-"),
+                       Node
+                       );
+       }
+}
+
 /**
  * \fn void MM_DumpTables(tVAddr Start, tVAddr End)
  * \brief Dumps the layout of the page tables
@@ -307,17 +380,7 @@ void MM_DumpTables(tVAddr Start, tVAddr End)
                {
                        if(expected) {
                                tPAddr  orig = gaPageTable[rangeStart>>12];
-                               Log(" 0x%08x => 0x%08x - 0x%08x (%s%s%s%s%s) %p",
-                                       rangeStart,
-                                       orig & ~0xFFF,
-                                       curPos - rangeStart,
-                                       (orig & PF_NOPAGE ? "P" : "-"),
-                                       (orig & PF_COW ? "C" : "-"),
-                                       (orig & PF_GLOBAL ? "G" : "-"),
-                                       (orig & PF_USER ? "U" : "-"),
-                                       (orig & PF_WRITE ? "W" : "-"),
-                                       expected_node
-                                       );
+                               MM_DumpTables_Print(rangeStart, orig, curPos - rangeStart, expected_node);
                                expected = 0;
                        }
                        if( !(gaPageDir[curPos>>22] & PF_PRESENT) )     continue;
@@ -327,22 +390,13 @@ void MM_DumpTables(tVAddr Start, tVAddr End)
                        MM_GetPageNode(expected, &expected_node);
                        rangeStart = curPos;
                }
-               if(expected)    expected += 0x1000;
+               if(expected && (expected & ~(PAGE_SIZE-1)) != giMM_ZeroPage)
+                       expected += 0x1000;
        }
        
        if(expected) {
                tPAddr  orig = gaPageTable[rangeStart>>12];
-               Log("0x%08x => 0x%08x - 0x%08x (%s%s%s%s%s) %p",
-                       rangeStart,
-                       orig & ~0xFFF,
-                       curPos - rangeStart,
-                       (orig & PF_NOPAGE ? "p" : "-"),
-                       (orig & PF_COW ? "C" : "-"),
-                       (orig & PF_GLOBAL ? "G" : "-"),
-                       (orig & PF_USER ? "U" : "-"),
-                       (orig & PF_WRITE ? "W" : "-"),
-                       expected_node
-                       );
+               MM_DumpTables_Print(rangeStart, orig, curPos - rangeStart, expected_node);
                expected = 0;
        }
 }
@@ -353,7 +407,8 @@ void MM_DumpTables(tVAddr Start, tVAddr End)
 tPAddr MM_Allocate(volatile void * VAddr)
 {
        tPAddr  paddr = MM_AllocPhys();
-       if( MM_Map(VAddr, paddr) ) {
+       if( MM_Map(VAddr, paddr) )
+       {
                return paddr;
        }
        
@@ -394,6 +449,7 @@ void MM_AllocateZero(volatile void *VAddr)
        else
        {
                MM_Map(VAddr, giMM_ZeroPage);
+               MM_RefPhys(giMM_ZeroPage);
        }
        MM_SetFlags(VAddr, MM_PFLAG_COW, MM_PFLAG_COW);
 }
@@ -411,9 +467,9 @@ int MM_Map(volatile void *VAddr, tPAddr PAddr)
        #endif
 
        // Sanity check
-       if( PAddr & 0xFFF || (tVAddr)VAddr & 0xFFF ) {
-               Log_Warning("MM_Virt", "MM_Map - Physical or Virtual Addresses are not aligned (0x%P and %p)",
-                       PAddr, VAddr);
+       if( (PAddr & 0xFFF) || ((tVAddr)VAddr & 0xFFF) ) {
+               Log_Warning("MM_Virt", "MM_Map - Physical or Virtual Addresses are not aligned (%P and %p) - %p",
+                       PAddr, VAddr, __builtin_return_address(0));
                //LEAVE('i', 0);
                return 0;
        }
@@ -441,9 +497,6 @@ int MM_Map(volatile void *VAddr, tPAddr PAddr)
        // Map
        gaPageTable[ pagenum ] = PAddr | 3 | (is_user ? PF_USER : 0);
        
-       // Reference
-       MM_RefPhys( PAddr );
-       
        INVLPG( VAddr );
        
        return 1;
@@ -588,7 +641,6 @@ tPAddr MM_Clone(int bNoUserCopy)
        tPAddr  ret;
        Uint    page = 0;
        tVAddr  kStackBase = Proc_GetCurThread()->KernelStack - MM_KERNEL_STACK_SIZE;
-       void    *tmp;
        
        // Create Directory Table
        ret = MM_AllocPhys();
@@ -697,10 +749,8 @@ tPAddr MM_Clone(int bNoUserCopy)
                        // Allocate page
                        gaTmpTable[i*1024+j] = MM_AllocPhys() | 3;
                        
-                       MM_RefPhys( gaTmpTable[i*1024+j] & ~0xFFF );
-                       
-                       tmp = MM_MapTemp( gaTmpTable[i*1024+j] & ~0xFFF );
-                       memcpy( tmp, (void *)( (i*1024+j)*0x1000 ), 0x1000 );
+                       void *tmp = MM_MapTemp( gaTmpTable[i*1024+j] & ~0xFFF );
+                       memcpy( tmp, (void *)( (i*1024+j)*PAGE_SIZE ), PAGE_SIZE );
                        MM_FreeTemp( tmp );
                }
        }
@@ -1127,10 +1177,10 @@ void *MM_AllocDMA(int Pages, int MaxBits, tPAddr *PhysAddr)
        
        // Allocated successfully, now map
        ret = MM_MapHWPages(phys, Pages);
+       // - MapHWPages references the memory, so release references
+       for( int i = 0; i < Pages; i ++ )
+               MM_DerefPhys(phys + i*PAGE_SIZE);
        if( ret == 0 ) {
-               // If it didn't map, free then return 0
-               for(;Pages--;phys+=0x1000)
-                       MM_DerefPhys(phys);
                LEAVE('i', 0);
                return 0;
        }

UCC git Repository :: git.ucc.asn.au