1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
|
/******************************************************************************
* dom0_ops.c
*
* Process command requests from domain-0 guest OS.
*
* Copyright (c) 2002, K A Fraser
*/
#include <xeno/config.h>
#include <xeno/types.h>
#include <xeno/lib.h>
#include <xeno/dom0_ops.h>
#include <xeno/sched.h>
#include <xeno/event.h>
#include <asm/domain_page.h>
extern unsigned int alloc_new_dom_mem(struct task_struct *, unsigned int);
static unsigned int get_domnr(void)
{
struct task_struct *p = &idle0_task;
unsigned long dom_mask = 0;
read_lock_irq(&tasklist_lock);
do {
if ( is_idle_task(p) ) continue;
set_bit(p->domain, &dom_mask);
}
while ( (p = p->next_task) != &idle0_task );
read_unlock_irq(&tasklist_lock);
return (dom_mask == ~0UL) ? 0 : ffz(dom_mask);
}
static void build_page_list(struct task_struct *p)
{
unsigned long * list;
unsigned long curr;
unsigned long page;
list = (unsigned long *)map_domain_mem(p->pg_head << PAGE_SHIFT);
curr = p->pg_head;
*list++ = p->pg_head;
page = (frame_table + p->pg_head)->next;
while(page != p->pg_head){
if(!((unsigned long)list & (PAGE_SIZE-1))){
curr = (frame_table + curr)->next;
unmap_domain_mem((unsigned long)(list-1) & PAGE_MASK);
list = (unsigned long *)map_domain_mem(curr << PAGE_SHIFT);
}
*list++ = page;
page = (frame_table + page)->next;
}
unmap_domain_mem((unsigned long)(list-1) & PAGE_MASK);
}
long do_dom0_op(dom0_op_t *u_dom0_op)
{
long ret = 0;
dom0_op_t op;
if ( current->domain != 0 )
return -EPERM;
if ( copy_from_user(&op, u_dom0_op, sizeof(op)) )
return -EFAULT;
switch ( op.cmd )
{
case DOM0_STARTDOM:
{
struct task_struct * p = find_domain_by_id(op.u.meminfo.domain);
ret = final_setup_guestos(p, &op.u.meminfo);
if( ret != 0 ){
p->state = TASK_DYING;
release_task(p);
break;
}
wake_up(p);
reschedule(p);
ret = p->domain;
}
break;
case DOM0_NEWDOMAIN:
{
struct task_struct *p;
static unsigned int pro = 0;
unsigned int dom = get_domnr();
ret = -ENOMEM;
if ( !dom ) break;
p = do_newdomain();
if ( !p ) break;
p->domain = dom;
pro = (pro+1) % smp_num_cpus;
p->processor = pro;
/* if we are not booting dom 0 than only mem
* needs to be allocated
*/
if(dom != 0){
if(alloc_new_dom_mem(p, op.u.newdomain.memory_kb) != 0){
ret = -1;
break;
}
build_page_list(p);
ret = p->domain;
op.u.newdomain.domain = ret;
op.u.newdomain.pg_head = p->pg_head;
copy_to_user(u_dom0_op, &op, sizeof(op));
break;
}
/* executed only in case of domain 0 */
ret = setup_guestos(p, &op.u.newdomain); /* Load guest OS into @p */
if ( ret != 0 )
{
p->state = TASK_DYING;
release_task(p);
break;
}
wake_up(p); /* Put @p on runqueue */
reschedule(p); /* Force a scheduling decision on @p's CPU */
ret = p->domain;
}
break;
case DOM0_KILLDOMAIN:
{
unsigned int dom = op.u.killdomain.domain;
if ( dom == IDLE_DOMAIN_ID )
{
ret = -EPERM;
}
else
{
ret = kill_other_domain(dom);
}
}
break;
case DOM0_MAPTASK:
{
unsigned int dom = op.u.mapdomts.domain;
op.u.mapdomts.ts_phy_addr = __pa(find_domain_by_id(dom));
copy_to_user(u_dom0_op, &op, sizeof(op));
}
break;
default:
ret = -ENOSYS;
}
return ret;
}
|
