123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164 |
- #include "process.h"
- #include <common/printk.h>
- #include <common/kprint.h>
- #include <common/stdio.h>
- #include <common/string.h>
- #include <common/compiler.h>
- #include <common/libELF/elf.h>
- #include <common/time.h>
- #include <common/sys/wait.h>
- #include <driver/video/video.h>
- #include <driver/usb/usb.h>
- #include <exception/gate.h>
- #include <filesystem/fat32/fat32.h>
- #include <mm/slab.h>
- #include <common/spinlock.h>
- #include <syscall/syscall.h>
- #include <syscall/syscall_num.h>
- #include <sched/sched.h>
- #include <common/unistd.h>
- #include <debug/traceback/traceback.h>
- #include <ktest/ktest.h>
- #include <mm/mmio.h>
- spinlock_t process_global_pid_write_lock;
- long process_global_pid = 1;
- extern void system_call(void);
- extern void kernel_thread_func(void);
- ul _stack_start;
- extern struct mm_struct initial_mm;
- struct thread_struct initial_thread =
- {
- .rbp = (ul)(initial_proc_union.stack + STACK_SIZE / sizeof(ul)),
- .rsp = (ul)(initial_proc_union.stack + STACK_SIZE / sizeof(ul)),
- .fs = KERNEL_DS,
- .gs = KERNEL_DS,
- .cr2 = 0,
- .trap_num = 0,
- .err_code = 0};
- union proc_union initial_proc_union __attribute__((__section__(".data.init_proc_union"))) = {INITIAL_PROC(initial_proc_union.pcb)};
- struct process_control_block *initial_proc[MAX_CPU_NUM] = {&initial_proc_union.pcb, 0};
- struct tss_struct initial_tss[MAX_CPU_NUM] = {[0 ... MAX_CPU_NUM - 1] = INITIAL_TSS};
- uint64_t process_copy_flags(uint64_t clone_flags, struct process_control_block *pcb);
- uint64_t process_copy_files(uint64_t clone_flags, struct process_control_block *pcb);
- uint64_t process_exit_files(struct process_control_block *pcb);
- uint64_t process_copy_mm(uint64_t clone_flags, struct process_control_block *pcb);
- uint64_t process_exit_mm(struct process_control_block *pcb);
- uint64_t process_copy_thread(uint64_t clone_flags, struct process_control_block *pcb, uint64_t stack_start, uint64_t stack_size, struct pt_regs *current_regs);
- void process_exit_thread(struct process_control_block *pcb);
- #pragma GCC push_options
- #pragma GCC optimize("O0")
- void __switch_to(struct process_control_block *prev, struct process_control_block *next)
- {
- initial_tss[proc_current_cpu_id].rsp0 = next->thread->rbp;
-
-
-
- __asm__ __volatile__("movq %%fs, %0 \n\t"
- : "=a"(prev->thread->fs));
- __asm__ __volatile__("movq %%gs, %0 \n\t"
- : "=a"(prev->thread->gs));
- __asm__ __volatile__("movq %0, %%fs \n\t" ::"a"(next->thread->fs));
- __asm__ __volatile__("movq %0, %%gs \n\t" ::"a"(next->thread->gs));
- }
- #pragma GCC pop_options
- struct vfs_file_t *process_open_exec_file(char *path)
- {
- struct vfs_dir_entry_t *dentry = NULL;
- struct vfs_file_t *filp = NULL;
- dentry = vfs_path_walk(path, 0);
- if (dentry == NULL)
- return (void *)-ENOENT;
- if (dentry->dir_inode->attribute == VFS_ATTR_DIR)
- return (void *)-ENOTDIR;
- filp = (struct vfs_file_t *)kmalloc(sizeof(struct vfs_file_t), 0);
- if (filp == NULL)
- return (void *)-ENOMEM;
- filp->position = 0;
- filp->mode = 0;
- filp->dEntry = dentry;
- filp->mode = ATTR_READ_ONLY;
- filp->file_ops = dentry->dir_inode->file_ops;
- return filp;
- }
- static int process_load_elf_file(struct pt_regs *regs, char *path)
- {
- int retval = 0;
- struct vfs_file_t *filp = process_open_exec_file(path);
- if ((long)filp <= 0 && (long)filp >= -255)
- {
-
- return (unsigned long)filp;
- }
- void *buf = kmalloc(PAGE_4K_SIZE, 0);
- memset(buf, 0, PAGE_4K_SIZE);
- uint64_t pos = 0;
- pos = filp->file_ops->lseek(filp, 0, SEEK_SET);
- retval = filp->file_ops->read(filp, (char *)buf, sizeof(Elf64_Ehdr), &pos);
- retval = 0;
- if (!elf_check(buf))
- {
- kerror("Not an ELF file: %s", path);
- retval = -ENOTSUP;
- goto load_elf_failed;
- }
- #if ARCH(X86_64)
-
- if (((Elf32_Ehdr *)buf)->e_ident[EI_CLASS] != ELFCLASS64)
- {
- kdebug("((Elf32_Ehdr *)buf)->e_ident[EI_CLASS]=%d", ((Elf32_Ehdr *)buf)->e_ident[EI_CLASS]);
- retval = -EUNSUPPORTED;
- goto load_elf_failed;
- }
- Elf64_Ehdr ehdr = *(Elf64_Ehdr *)buf;
-
- if (ehdr.e_machine != EM_AMD64)
- {
- kerror("e_machine=%d", ehdr.e_machine);
- retval = -EUNSUPPORTED;
- goto load_elf_failed;
- }
- #else
- #error Unsupported architecture!
- #endif
- if (ehdr.e_type != ET_EXEC)
- {
- kerror("Not executable file! filename=%s\tehdr->e_type=%d", path, ehdr.e_type);
- retval = -EUNSUPPORTED;
- goto load_elf_failed;
- }
-
- regs->rip = ehdr.e_entry;
- current_pcb->mm->code_addr_start = ehdr.e_entry;
-
-
- pos = ehdr.e_phoff;
-
- pos = filp->file_ops->lseek(filp, pos, SEEK_SET);
- filp->file_ops->read(filp, (char *)buf, (uint64_t)ehdr.e_phentsize * (uint64_t)ehdr.e_phnum, &pos);
- if ((unsigned long)filp <= 0)
- {
- kdebug("(unsigned long)filp=%d", (long)filp);
- retval = -ENOEXEC;
- goto load_elf_failed;
- }
- Elf64_Phdr *phdr = buf;
-
- for (int i = 0; i < ehdr.e_phnum; ++i, ++phdr)
- {
-
-
- if (phdr->p_type != PT_LOAD)
- continue;
- int64_t remain_mem_size = phdr->p_memsz;
- int64_t remain_file_size = phdr->p_filesz;
- pos = phdr->p_offset;
- uint64_t virt_base = phdr->p_vaddr;
- while (remain_mem_size > 0)
- {
-
- int64_t map_size = 0;
- if (remain_mem_size > PAGE_2M_SIZE / 2)
- {
- uint64_t pa = alloc_pages(ZONE_NORMAL, 1, PAGE_PGT_MAPPED)->addr_phys;
- struct vm_area_struct *vma = NULL;
- int ret = mm_create_vma(current_pcb->mm, virt_base, PAGE_2M_SIZE, VM_USER | VM_ACCESS_FLAGS, NULL, &vma);
-
- if (ret == -EEXIST)
- free_pages(Phy_to_2M_Page(pa), 1);
- else
- mm_map_vma(vma, pa);
- memset((void *)virt_base, 0, PAGE_2M_SIZE);
- map_size = PAGE_2M_SIZE;
- }
- else
- {
-
- map_size = ALIGN(remain_mem_size, PAGE_4K_SIZE);
-
- for (uint64_t off = 0; off < map_size; off += PAGE_4K_SIZE)
- {
- uint64_t paddr = virt_2_phys((uint64_t)kmalloc(PAGE_4K_SIZE, 0));
- struct vm_area_struct *vma = NULL;
- int val = mm_create_vma(current_pcb->mm, virt_base + off, PAGE_4K_SIZE, VM_USER | VM_ACCESS_FLAGS, NULL, &vma);
- if (val == -EEXIST)
- kfree(phys_2_virt(paddr));
- else
- mm_map_vma(vma, paddr);
- memset((void *)(virt_base + off), 0, PAGE_4K_SIZE);
- }
- }
- pos = filp->file_ops->lseek(filp, pos, SEEK_SET);
- int64_t val = 0;
- if (remain_file_size != 0)
- {
- int64_t to_trans = (remain_file_size > PAGE_2M_SIZE) ? PAGE_2M_SIZE : remain_file_size;
- val = filp->file_ops->read(filp, (char *)virt_base, to_trans, &pos);
- }
- if (val < 0)
- goto load_elf_failed;
- remain_mem_size -= map_size;
- remain_file_size -= val;
- virt_base += map_size;
- }
- }
-
- regs->rsp = current_pcb->mm->stack_start;
- regs->rbp = current_pcb->mm->stack_start;
- {
- struct vm_area_struct *vma = NULL;
- uint64_t pa = alloc_pages(ZONE_NORMAL, 1, PAGE_PGT_MAPPED)->addr_phys;
- int val = mm_create_vma(current_pcb->mm, current_pcb->mm->stack_start - PAGE_2M_SIZE, PAGE_2M_SIZE, VM_USER | VM_ACCESS_FLAGS, NULL, &vma);
- if (val == -EEXIST)
- free_pages(Phy_to_2M_Page(pa), 1);
- else
- mm_map_vma(vma, pa);
- }
-
- memset((void *)(current_pcb->mm->stack_start - PAGE_2M_SIZE), 0, PAGE_2M_SIZE);
- load_elf_failed:;
- if (buf != NULL)
- kfree(buf);
- return retval;
- }
- #pragma GCC push_options
- #pragma GCC optimize("O0")
- ul do_execve(struct pt_regs *regs, char *path, char *argv[], char *envp[])
- {
-
-
-
- if (current_pcb->flags & PF_VFORK)
- {
- kdebug("proc:%d creating new mem space", current_pcb->pid);
-
- struct mm_struct *new_mms = (struct mm_struct *)kmalloc(sizeof(struct mm_struct), 0);
- memset(new_mms, 0, sizeof(struct mm_struct));
- current_pcb->mm = new_mms;
-
- new_mms->pgd = (pml4t_t *)virt_2_phys(kmalloc(PAGE_4K_SIZE, 0));
-
- memset(phys_2_virt(new_mms->pgd), 0, PAGE_4K_SIZE / 2);
-
- memcpy(phys_2_virt(new_mms->pgd) + 256, phys_2_virt(initial_proc[proc_current_cpu_id]) + 256, PAGE_4K_SIZE / 2);
- }
-
- unsigned long stack_start_addr = 0x6ffff0a00000UL;
- const uint64_t brk_start_addr = 0x700000000000UL;
- process_switch_mm(current_pcb);
-
- if (!(current_pcb->flags & PF_KTHREAD))
- current_pcb->addr_limit = USER_MAX_LINEAR_ADDR;
- current_pcb->mm->code_addr_end = 0;
- current_pcb->mm->data_addr_start = 0;
- current_pcb->mm->data_addr_end = 0;
- current_pcb->mm->rodata_addr_start = 0;
- current_pcb->mm->rodata_addr_end = 0;
- current_pcb->mm->bss_start = 0;
- current_pcb->mm->bss_end = 0;
- current_pcb->mm->brk_start = brk_start_addr;
- current_pcb->mm->brk_end = brk_start_addr;
- current_pcb->mm->stack_start = stack_start_addr;
-
- process_exit_files(current_pcb);
-
- current_pcb->flags &= ~PF_VFORK;
-
- int tmp = process_load_elf_file(regs, path);
- if (tmp < 0)
- goto exec_failed;
-
- if (argv != NULL)
- {
- int argc = 0;
-
- char **dst_argv = (char **)(stack_start_addr - (sizeof(char **) << 3));
- uint64_t str_addr = (uint64_t)dst_argv;
- for (argc = 0; argc < 8 && argv[argc] != NULL; ++argc)
- {
- if (*argv[argc] == NULL)
- break;
-
- int argv_len = strnlen_user(argv[argc], 1023) + 1;
- strncpy((char *)(str_addr - argv_len), argv[argc], argv_len - 1);
- str_addr -= argv_len;
- dst_argv[argc] = (char *)str_addr;
-
- ((char *)str_addr)[argv_len] = '\0';
- }
-
- stack_start_addr = str_addr - 8;
- current_pcb->mm->stack_start = stack_start_addr;
- regs->rsp = regs->rbp = stack_start_addr;
-
- regs->rdi = argc;
- regs->rsi = (uint64_t)dst_argv;
- }
-
- regs->cs = USER_CS | 3;
- regs->ds = USER_DS | 3;
- regs->ss = USER_DS | 0x3;
- regs->rflags = 0x200246;
- regs->rax = 1;
- regs->es = 0;
- return 0;
- exec_failed:;
- process_do_exit(tmp);
- }
- #pragma GCC pop_options
- #pragma GCC push_options
- #pragma GCC optimize("O0")
- ul initial_kernel_thread(ul arg)
- {
-
- fat32_init();
- usb_init();
-
- uint64_t tpid[] = {
- ktest_start(ktest_test_bitree, 0),
- ktest_start(ktest_test_kfifo, 0),
- ktest_start(ktest_test_mutex, 0),
- };
- kinfo("Waiting test thread exit...");
-
- for (int i = 0; i < sizeof(tpid) / sizeof(uint64_t); ++i)
- waitpid(tpid[i], NULL, NULL);
- kinfo("All test done.");
-
-
-
-
-
-
-
-
-
- struct pt_regs *regs;
-
- cli();
- current_pcb->thread->rip = (ul)ret_from_system_call;
- current_pcb->thread->rsp = (ul)current_pcb + STACK_SIZE - sizeof(struct pt_regs);
- current_pcb->thread->fs = USER_DS | 0x3;
- barrier();
- current_pcb->thread->gs = USER_DS | 0x3;
-
- current_pcb->flags &= (~PF_KTHREAD);
- kdebug("in initial_kernel_thread: flags=%ld", current_pcb->flags);
- regs = (struct pt_regs *)current_pcb->thread->rsp;
-
- current_pcb->flags = 0;
-
-
- char init_path[] = "/shell.elf";
- uint64_t addr = (uint64_t)&init_path;
- __asm__ __volatile__("movq %1, %%rsp \n\t"
- "pushq %2 \n\t"
- "jmp do_execve \n\t" ::"D"(current_pcb->thread->rsp),
- "m"(current_pcb->thread->rsp), "m"(current_pcb->thread->rip), "S"("/shell.elf"), "c"(NULL), "d"(NULL)
- : "memory");
- return 1;
- }
- #pragma GCC pop_options
- void process_exit_notify()
- {
- wait_queue_wakeup(¤t_pcb->parent_pcb->wait_child_proc_exit, PROC_INTERRUPTIBLE);
- }
- ul process_do_exit(ul code)
- {
-
- cli();
- struct process_control_block *pcb = current_pcb;
-
- process_exit_files(pcb);
- process_exit_thread(pcb);
-
- pcb->state = PROC_ZOMBIE;
- pcb->exit_code = code;
- sti();
- process_exit_notify();
- sched();
- while (1)
- pause();
- }
- int kernel_thread(unsigned long (*fn)(unsigned long), unsigned long arg, unsigned long flags)
- {
- struct pt_regs regs;
- barrier();
- memset(®s, 0, sizeof(regs));
- barrier();
-
- regs.rbx = (ul)fn;
-
- regs.rdx = (ul)arg;
- barrier();
- regs.ds = KERNEL_DS;
- barrier();
- regs.es = KERNEL_DS;
- barrier();
- regs.cs = KERNEL_CS;
- barrier();
- regs.ss = KERNEL_DS;
- barrier();
-
- regs.rflags = (1 << 9);
- barrier();
-
- regs.rip = (ul)kernel_thread_func;
- barrier();
-
-
-
- return do_fork(®s, flags | CLONE_VM, 0, 0);
- }
- void process_init()
- {
- kinfo("Initializing process...");
- initial_mm.pgd = (pml4t_t *)get_CR3();
- initial_mm.code_addr_start = memory_management_struct.kernel_code_start;
- initial_mm.code_addr_end = memory_management_struct.kernel_code_end;
- initial_mm.data_addr_start = (ul)&_data;
- initial_mm.data_addr_end = memory_management_struct.kernel_data_end;
- initial_mm.rodata_addr_start = (ul)&_rodata;
- initial_mm.rodata_addr_end = (ul)&_erodata;
- initial_mm.bss_start = (uint64_t)&_bss;
- initial_mm.bss_end = (uint64_t)&_ebss;
- initial_mm.brk_start = memory_management_struct.start_brk;
- initial_mm.brk_end = current_pcb->addr_limit;
- initial_mm.stack_start = _stack_start;
- initial_mm.vmas = NULL;
- initial_tss[proc_current_cpu_id].rsp0 = initial_thread.rbp;
-
-
-
- uint64_t *idle_pml4t_vaddr = (uint64_t *)phys_2_virt((uint64_t)get_CR3() & (~0xfffUL));
- for (int i = 256; i < 512; ++i)
- {
- uint64_t *tmp = idle_pml4t_vaddr + i;
- barrier();
- if (*tmp == 0)
- {
- void *pdpt = kmalloc(PAGE_4K_SIZE, 0);
- barrier();
- memset(pdpt, 0, PAGE_4K_SIZE);
- barrier();
- set_pml4t(tmp, mk_pml4t(virt_2_phys(pdpt), PAGE_KERNEL_PGT));
- }
- }
- barrier();
- flush_tlb();
-
-
- spin_init(&process_global_pid_write_lock);
-
- list_init(&initial_proc_union.pcb.list);
- barrier();
- kernel_thread(initial_kernel_thread, 10, CLONE_FS | CLONE_SIGNAL);
- barrier();
- initial_proc_union.pcb.state = PROC_RUNNING;
- initial_proc_union.pcb.preempt_count = 0;
- initial_proc_union.pcb.cpu_id = 0;
- initial_proc_union.pcb.virtual_runtime = (1UL << 60);
- current_pcb->virtual_runtime = (1UL << 60);
- }
- unsigned long do_fork(struct pt_regs *regs, unsigned long clone_flags, unsigned long stack_start, unsigned long stack_size)
- {
- int retval = 0;
- struct process_control_block *tsk = NULL;
-
- tsk = (struct process_control_block *)kmalloc(STACK_SIZE, 0);
- barrier();
- if (tsk == NULL)
- {
- retval = -ENOMEM;
- return retval;
- }
- barrier();
- memset(tsk, 0, sizeof(struct process_control_block));
- io_mfence();
-
- memcpy(tsk, current_pcb, sizeof(struct process_control_block));
- io_mfence();
-
- list_init(&tsk->list);
- io_mfence();
-
- if (current_pcb->flags & PF_KTHREAD && stack_start != 0)
- tsk->flags |= PF_KFORK;
- tsk->priority = 2;
- tsk->preempt_count = 0;
-
- spin_lock(&process_global_pid_write_lock);
- tsk->pid = process_global_pid++;
- barrier();
-
- tsk->next_pcb = initial_proc_union.pcb.next_pcb;
- barrier();
- initial_proc_union.pcb.next_pcb = tsk;
- barrier();
- tsk->parent_pcb = current_pcb;
- barrier();
- spin_unlock(&process_global_pid_write_lock);
- tsk->cpu_id = proc_current_cpu_id;
- tsk->state = PROC_UNINTERRUPTIBLE;
- tsk->parent_pcb = current_pcb;
- wait_queue_init(&tsk->wait_child_proc_exit, NULL);
- barrier();
- list_init(&tsk->list);
- retval = -ENOMEM;
-
- if (process_copy_flags(clone_flags, tsk))
- goto copy_flags_failed;
-
- if (process_copy_mm(clone_flags, tsk))
- goto copy_mm_failed;
-
- if (process_copy_files(clone_flags, tsk))
- goto copy_files_failed;
-
- if (process_copy_thread(clone_flags, tsk, stack_start, stack_size, regs))
- goto copy_thread_failed;
-
- retval = tsk->pid;
- tsk->flags &= ~PF_KFORK;
-
- process_wakeup(tsk);
- return retval;
- copy_thread_failed:;
-
- process_exit_thread(tsk);
- copy_files_failed:;
-
- process_exit_files(tsk);
- copy_mm_failed:;
-
- process_exit_mm(tsk);
- copy_flags_failed:;
- kfree(tsk);
- return retval;
- return 0;
- }
- struct process_control_block *process_get_pcb(long pid)
- {
- struct process_control_block *pcb = initial_proc_union.pcb.next_pcb;
-
-
- for (; pcb != &initial_proc_union.pcb; pcb = pcb->next_pcb)
- {
- if (pcb->pid == pid)
- return pcb;
- }
- return NULL;
- }
- void process_wakeup(struct process_control_block *pcb)
- {
- pcb->state = PROC_RUNNING;
- sched_enqueue(pcb);
- }
- void process_wakeup_immediately(struct process_control_block *pcb)
- {
- pcb->state = PROC_RUNNING;
- sched_enqueue(pcb);
-
- current_pcb->flags |= PF_NEED_SCHED;
- }
- uint64_t process_copy_flags(uint64_t clone_flags, struct process_control_block *pcb)
- {
- if (clone_flags & CLONE_VM)
- pcb->flags |= PF_VFORK;
- return 0;
- }
- uint64_t process_copy_files(uint64_t clone_flags, struct process_control_block *pcb)
- {
- int retval = 0;
-
-
- if (clone_flags & CLONE_FS)
- return retval;
-
- for (int i = 0; i < PROC_MAX_FD_NUM; ++i)
- {
- if (current_pcb->fds[i] == NULL)
- continue;
- pcb->fds[i] = (struct vfs_file_t *)kmalloc(sizeof(struct vfs_file_t), 0);
- memcpy(pcb->fds[i], current_pcb->fds[i], sizeof(struct vfs_file_t));
- }
- return retval;
- }
- uint64_t process_exit_files(struct process_control_block *pcb)
- {
-
- if (!(pcb->flags & PF_VFORK))
- {
- for (int i = 0; i < PROC_MAX_FD_NUM; ++i)
- {
- if (pcb->fds[i] == NULL)
- continue;
- kfree(pcb->fds[i]);
- }
- }
-
- memset(pcb->fds, 0, sizeof(struct vfs_file_t *) * PROC_MAX_FD_NUM);
- }
- uint64_t process_copy_mm(uint64_t clone_flags, struct process_control_block *pcb)
- {
- int retval = 0;
-
- if (clone_flags & CLONE_VM)
- {
- pcb->mm = current_pcb->mm;
- return retval;
- }
-
- struct mm_struct *new_mms = (struct mm_struct *)kmalloc(sizeof(struct mm_struct), 0);
- memset(new_mms, 0, sizeof(struct mm_struct));
- memcpy(new_mms, current_pcb->mm, sizeof(struct mm_struct));
- new_mms->vmas = NULL;
- pcb->mm = new_mms;
-
- new_mms->pgd = (pml4t_t *)virt_2_phys(kmalloc(PAGE_4K_SIZE, 0));
-
- memset(phys_2_virt(new_mms->pgd), 0, PAGE_4K_SIZE / 2);
-
- memcpy(phys_2_virt(new_mms->pgd) + 256, phys_2_virt(initial_proc[proc_current_cpu_id]->mm->pgd) + 256, PAGE_4K_SIZE / 2);
- uint64_t *current_pgd = (uint64_t *)phys_2_virt(current_pcb->mm->pgd);
- uint64_t *new_pml4t = (uint64_t *)phys_2_virt(new_mms->pgd);
-
- struct vm_area_struct *vma = current_pcb->mm->vmas;
- while (vma != NULL)
- {
- if (vma->vm_end > USER_MAX_LINEAR_ADDR || vma->vm_flags & VM_DONTCOPY)
- {
- vma = vma->vm_next;
- continue;
- }
- int64_t vma_size = vma->vm_end - vma->vm_start;
-
- if (vma_size > PAGE_2M_SIZE / 2)
- {
- int page_to_alloc = (PAGE_2M_ALIGN(vma_size)) >> PAGE_2M_SHIFT;
- for (int i = 0; i < page_to_alloc; ++i)
- {
- uint64_t pa = alloc_pages(ZONE_NORMAL, 1, PAGE_PGT_MAPPED)->addr_phys;
- struct vm_area_struct *new_vma = NULL;
- int ret = mm_create_vma(new_mms, vma->vm_start + i * PAGE_2M_SIZE, PAGE_2M_SIZE, vma->vm_flags, vma->vm_ops, &new_vma);
-
- if (unlikely(ret == -EEXIST))
- free_pages(Phy_to_2M_Page(pa), 1);
- else
- mm_map_vma(new_vma, pa);
- memcpy((void *)phys_2_virt(pa), (void *)(vma->vm_start + i * PAGE_2M_SIZE), (vma_size >= PAGE_2M_SIZE) ? PAGE_2M_SIZE : vma_size);
- vma_size -= PAGE_2M_SIZE;
- }
- }
- else
- {
- uint64_t map_size = PAGE_4K_ALIGN(vma_size);
- uint64_t va = (uint64_t)kmalloc(map_size, 0);
- struct vm_area_struct *new_vma = NULL;
- int ret = mm_create_vma(new_mms, vma->vm_start, map_size, vma->vm_flags, vma->vm_ops, &new_vma);
-
- if (unlikely(ret == -EEXIST))
- kfree((void *)va);
- else
- mm_map_vma(new_vma, virt_2_phys(va));
- memcpy((void *)va, (void *)vma->vm_start, vma_size);
- }
- vma = vma->vm_next;
- }
- return retval;
- }
- uint64_t process_exit_mm(struct process_control_block *pcb)
- {
- if (pcb->flags & CLONE_VM)
- return 0;
- if (pcb->mm == NULL)
- {
- kdebug("pcb->mm==NULL");
- return 0;
- }
- if (pcb->mm->pgd == NULL)
- {
- kdebug("pcb->mm->pgd==NULL");
- return 0;
- }
-
- pml4t_t *current_pgd = (pml4t_t *)phys_2_virt(pcb->mm->pgd);
-
- struct vm_area_struct *vma = pcb->mm->vmas;
- while (vma != NULL)
- {
- struct vm_area_struct *cur_vma = vma;
- vma = cur_vma->vm_next;
- uint64_t pa;
-
- mm_unmap_vma(pcb->mm, cur_vma, &pa);
- uint64_t size = (cur_vma->vm_end - cur_vma->vm_start);
-
- switch (size)
- {
- case PAGE_4K_SIZE:
- kfree(phys_2_virt(pa));
- break;
- default:
- break;
- }
- vm_area_del(cur_vma);
- vm_area_free(cur_vma);
- }
-
- kfree(current_pgd);
- if (unlikely(pcb->mm->vmas != NULL))
- {
- kwarn("pcb.mm.vmas!=NULL");
- }
-
- kfree(pcb->mm);
- return 0;
- }
- static int process_rewrite_rbp(struct pt_regs *new_regs, struct process_control_block *new_pcb)
- {
- uint64_t new_top = ((uint64_t)new_pcb) + STACK_SIZE;
- uint64_t old_top = (uint64_t)(current_pcb) + STACK_SIZE;
- uint64_t *rbp = &new_regs->rbp;
- uint64_t *tmp = rbp;
-
- if ((uint64_t)*rbp >= old_top || (uint64_t)*rbp < (old_top - STACK_SIZE))
- return 0;
- while (1)
- {
-
- uint64_t delta = old_top - *rbp;
-
- uint64_t newVal = new_top - delta;
-
- if (unlikely((uint64_t)newVal >= new_top || (uint64_t)newVal < (new_top - STACK_SIZE)))
- break;
-
- *rbp = newVal;
-
- rbp = (uint64_t *)*rbp;
- }
-
- new_regs->rsp = new_top - (old_top - new_regs->rsp);
- return 0;
- }
- uint64_t process_copy_thread(uint64_t clone_flags, struct process_control_block *pcb, uint64_t stack_start, uint64_t stack_size, struct pt_regs *current_regs)
- {
-
- struct thread_struct *thd = (struct thread_struct *)(pcb + 1);
- memset(thd, 0, sizeof(struct thread_struct));
- pcb->thread = thd;
- struct pt_regs *child_regs = NULL;
-
- if (pcb->flags & PF_KFORK)
- {
-
- uint32_t size = ((uint64_t)current_pcb) + STACK_SIZE - (uint64_t)(current_regs);
- child_regs = (struct pt_regs *)(((uint64_t)pcb) + STACK_SIZE - size);
- memcpy(child_regs, (void *)current_regs, size);
- barrier();
-
- process_rewrite_rbp(child_regs, pcb);
- }
- else
- {
- child_regs = (struct pt_regs *)((uint64_t)pcb + STACK_SIZE - sizeof(struct pt_regs));
- memcpy(child_regs, current_regs, sizeof(struct pt_regs));
- barrier();
- child_regs->rsp = stack_start;
- }
-
- child_regs->rax = 0;
- if (pcb->flags & PF_KFORK)
- thd->rbp = (uint64_t)(child_regs + 1);
- else
- thd->rbp = (uint64_t)pcb + STACK_SIZE;
-
- thd->rsp = (uint64_t)child_regs;
- thd->fs = current_pcb->thread->fs;
- thd->gs = current_pcb->thread->gs;
-
- if (pcb->flags & PF_KFORK)
- thd->rip = (uint64_t)ret_from_system_call;
- else if (pcb->flags & PF_KTHREAD && (!(pcb->flags & PF_KFORK)))
- thd->rip = (uint64_t)kernel_thread_func;
- else
- thd->rip = (uint64_t)ret_from_system_call;
- return 0;
- }
- void process_exit_thread(struct process_control_block *pcb)
- {
- }
- int process_fd_alloc(struct vfs_file_t *file)
- {
- int fd_num = -1;
- struct vfs_file_t **f = current_pcb->fds;
- for (int i = 0; i < PROC_MAX_FD_NUM; ++i) {
-
- if (f[i] == NULL) {
- fd_num = i;
- f[i] = file;
- break;
- }
- }
- return fd_num;
- }
|