blob: 378889bf6475573b29d6675e66a9da35bf81cdc2 [file] [log] [blame]
Ian Rogersb033c752011-07-20 12:22:35 -07001// Copyright 2011 Google Inc. All Rights Reserved.
2
Brian Carlstrom578bbdc2011-07-21 14:07:47 -07003#include "thread.h"
4
Ian Rogersb033c752011-07-20 12:22:35 -07005#include <asm/ldt.h>
6#include <sys/syscall.h>
7#include <sys/types.h>
Brian Carlstrom578bbdc2011-07-21 14:07:47 -07008
Ian Rogers9651f422011-09-19 20:26:07 -07009#include "asm_support.h"
Brian Carlstrom578bbdc2011-07-21 14:07:47 -070010#include "macros.h"
Ian Rogersb033c752011-07-20 12:22:35 -070011
12namespace art {
13
14void Thread::InitCpu() {
15 // Read LDT
16 CHECK_EQ((size_t)LDT_ENTRY_SIZE, sizeof(uint64_t));
Elliott Hughes3b6baaa2011-10-14 19:13:56 -070017 std::vector<uint64_t> ldt(LDT_ENTRIES);
18 size_t ldt_size(sizeof(uint64_t) * ldt.size());
19 memset(&ldt[0], 0, ldt_size);
20 syscall(SYS_modify_ldt, 0, &ldt[0], ldt_size);
Ian Rogersb033c752011-07-20 12:22:35 -070021 // Create empty slot to point at current Thread*
Elliott Hughes7f40ffc2011-09-04 10:50:01 -070022 user_desc ldt_entry;
23 memset(&ldt_entry, 0, sizeof(ldt_entry));
Ian Rogersb033c752011-07-20 12:22:35 -070024 ldt_entry.entry_number = -1;
25 ldt_entry.base_addr = (unsigned int)this;
Brian Carlstromb0460ea2011-07-29 10:08:05 -070026 ldt_entry.limit = kPageSize;
Ian Rogersb033c752011-07-20 12:22:35 -070027 ldt_entry.seg_32bit = 1;
28 ldt_entry.contents = MODIFY_LDT_CONTENTS_DATA;
29 ldt_entry.read_exec_only = 0;
30 ldt_entry.limit_in_pages = 0;
31 ldt_entry.seg_not_present = 0;
32 ldt_entry.useable = 1;
33 for (int i = 0; i < LDT_ENTRIES; i++) {
Elliott Hughes7f40ffc2011-09-04 10:50:01 -070034 if (ldt[i] == 0) {
Ian Rogersb033c752011-07-20 12:22:35 -070035 ldt_entry.entry_number = i;
36 break;
37 }
38 }
39 if (ldt_entry.entry_number >= LDT_ENTRIES) {
40 LOG(FATAL) << "Failed to find available LDT slot";
41 }
42 // Update LDT
43 CHECK_EQ(0, syscall(SYS_modify_ldt, 1, &ldt_entry, sizeof(ldt_entry)));
44 // Change FS to be new LDT entry
45 uint16_t table_indicator = 1 << 2; // LDT
46 uint16_t rpl = 3; // Requested privilege level
47 uint16_t selector = (ldt_entry.entry_number << 3) | table_indicator | rpl;
48 // TODO: use our assembler to generate code
Elliott Hughes7f40ffc2011-09-04 10:50:01 -070049 asm volatile("movw %w0, %%fs"
Ian Rogersb033c752011-07-20 12:22:35 -070050 : // output
51 : "q"(selector) // input
52 :); // clobber
53 // Allow easy indirection back to Thread*
54 self_ = this;
55 // Sanity check reads from FS goes to this Thread*
Ian Rogersb033c752011-07-20 12:22:35 -070056 Thread* self_check;
57 // TODO: use our assembler to generate code
Ian Rogers9651f422011-09-19 20:26:07 -070058 CHECK_EQ(THREAD_SELF_OFFSET, OFFSETOF_MEMBER(Thread, self_));
Elliott Hughes7f40ffc2011-09-04 10:50:01 -070059 asm volatile("movl %%fs:(%1), %0"
Ian Rogersb033c752011-07-20 12:22:35 -070060 : "=r"(self_check) // output
Ian Rogers9651f422011-09-19 20:26:07 -070061 : "r"(THREAD_SELF_OFFSET) // input
Ian Rogersb033c752011-07-20 12:22:35 -070062 :); // clobber
63 CHECK_EQ(self_check, this);
64}
65
66} // namespace art