Ian Rogers | b033c75 | 2011-07-20 12:22:35 -0700 | [diff] [blame] | 1 | // Copyright 2011 Google Inc. All Rights Reserved. |
| 2 | |
Brian Carlstrom | 578bbdc | 2011-07-21 14:07:47 -0700 | [diff] [blame] | 3 | #include "thread.h" |
| 4 | |
Ian Rogers | b033c75 | 2011-07-20 12:22:35 -0700 | [diff] [blame] | 5 | #include <asm/ldt.h> |
| 6 | #include <sys/syscall.h> |
| 7 | #include <sys/types.h> |
Brian Carlstrom | 578bbdc | 2011-07-21 14:07:47 -0700 | [diff] [blame] | 8 | |
| 9 | #include "macros.h" |
Ian Rogers | b033c75 | 2011-07-20 12:22:35 -0700 | [diff] [blame] | 10 | |
| 11 | namespace art { |
| 12 | |
| 13 | void Thread::InitCpu() { |
| 14 | // Read LDT |
| 15 | CHECK_EQ((size_t)LDT_ENTRY_SIZE, sizeof(uint64_t)); |
Elliott Hughes | 7f40ffc | 2011-09-04 10:50:01 -0700 | [diff] [blame] | 16 | uint64_t ldt[LDT_ENTRIES]; |
| 17 | memset(ldt, 0, sizeof(ldt)); |
| 18 | syscall(SYS_modify_ldt, 0, ldt, sizeof(ldt)); |
Ian Rogers | b033c75 | 2011-07-20 12:22:35 -0700 | [diff] [blame] | 19 | // Create empty slot to point at current Thread* |
Elliott Hughes | 7f40ffc | 2011-09-04 10:50:01 -0700 | [diff] [blame] | 20 | user_desc ldt_entry; |
| 21 | memset(&ldt_entry, 0, sizeof(ldt_entry)); |
Ian Rogers | b033c75 | 2011-07-20 12:22:35 -0700 | [diff] [blame] | 22 | ldt_entry.entry_number = -1; |
| 23 | ldt_entry.base_addr = (unsigned int)this; |
Brian Carlstrom | b0460ea | 2011-07-29 10:08:05 -0700 | [diff] [blame] | 24 | ldt_entry.limit = kPageSize; |
Ian Rogers | b033c75 | 2011-07-20 12:22:35 -0700 | [diff] [blame] | 25 | ldt_entry.seg_32bit = 1; |
| 26 | ldt_entry.contents = MODIFY_LDT_CONTENTS_DATA; |
| 27 | ldt_entry.read_exec_only = 0; |
| 28 | ldt_entry.limit_in_pages = 0; |
| 29 | ldt_entry.seg_not_present = 0; |
| 30 | ldt_entry.useable = 1; |
| 31 | for (int i = 0; i < LDT_ENTRIES; i++) { |
Elliott Hughes | 7f40ffc | 2011-09-04 10:50:01 -0700 | [diff] [blame] | 32 | if (ldt[i] == 0) { |
Ian Rogers | b033c75 | 2011-07-20 12:22:35 -0700 | [diff] [blame] | 33 | ldt_entry.entry_number = i; |
| 34 | break; |
| 35 | } |
| 36 | } |
| 37 | if (ldt_entry.entry_number >= LDT_ENTRIES) { |
| 38 | LOG(FATAL) << "Failed to find available LDT slot"; |
| 39 | } |
| 40 | // Update LDT |
| 41 | CHECK_EQ(0, syscall(SYS_modify_ldt, 1, &ldt_entry, sizeof(ldt_entry))); |
| 42 | // Change FS to be new LDT entry |
| 43 | uint16_t table_indicator = 1 << 2; // LDT |
| 44 | uint16_t rpl = 3; // Requested privilege level |
| 45 | uint16_t selector = (ldt_entry.entry_number << 3) | table_indicator | rpl; |
| 46 | // TODO: use our assembler to generate code |
Elliott Hughes | 7f40ffc | 2011-09-04 10:50:01 -0700 | [diff] [blame] | 47 | asm volatile("movw %w0, %%fs" |
Ian Rogers | b033c75 | 2011-07-20 12:22:35 -0700 | [diff] [blame] | 48 | : // output |
| 49 | : "q"(selector) // input |
| 50 | :); // clobber |
| 51 | // Allow easy indirection back to Thread* |
| 52 | self_ = this; |
| 53 | // Sanity check reads from FS goes to this Thread* |
Ian Rogers | b033c75 | 2011-07-20 12:22:35 -0700 | [diff] [blame] | 54 | Thread* self_check; |
| 55 | // TODO: use our assembler to generate code |
Elliott Hughes | 7f40ffc | 2011-09-04 10:50:01 -0700 | [diff] [blame] | 56 | asm volatile("movl %%fs:(%1), %0" |
Ian Rogers | b033c75 | 2011-07-20 12:22:35 -0700 | [diff] [blame] | 57 | : "=r"(self_check) // output |
Carl Shapiro | 69759ea | 2011-07-21 18:13:35 -0700 | [diff] [blame] | 58 | : "r"(OFFSETOF_MEMBER(Thread, self_)) // input |
Ian Rogers | b033c75 | 2011-07-20 12:22:35 -0700 | [diff] [blame] | 59 | :); // clobber |
| 60 | CHECK_EQ(self_check, this); |
| 61 | } |
| 62 | |
| 63 | } // namespace art |