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
|
/* $OpenBSD: uthread_machdep.c,v 1.3 2000/10/05 04:59:34 rahnds Exp $ */
/* David Leonard, <d@csee.uq.edu.au>. Public domain */
#include <pthread.h>
#include "pthread_private.h"
#define ALIGNBYTES 0xf
/* Register save frame as it appears on the stack */
struct frame {
int r1;
int reserved;
int gp[32-14];
int lr, cr, ctr, xer;
long fp[32-14];
long fs;
/* The rest are only valid in the initial frame */
int next_r1;
int next_lr;
};
/*
* Given a stack and an entry function, initialise a state
* structure that can be later switched to.
*/
void
_thread_machdep_init(statep, base, len, entry)
struct _machdep_state* statep;
void *base;
int len;
void (*entry)(void);
{
struct frame *f;
/* Locate the initial frame, aligned at the top of the stack */
f = (struct frame *)(((int)base + len - sizeof *f) & ~ALIGNBYTES);
f->r1 = (int)&f->next_r1;
f->reserved = 0;
f->lr = (int)entry;
f->next_r1 = 0; /* for gdb */
f->next_lr = 0; /* for gdb */
/* Initialise the new thread with all the state from this thread. */
#define copyreg(x) __asm__ volatile ("stw " #x ", %0" : "=m"(f->gp[x-14]))
copyreg(14); copyreg(15); copyreg(16); copyreg(17); copyreg(18);
copyreg(19); copyreg(20); copyreg(21); copyreg(22); copyreg(23);
copyreg(24); copyreg(25); copyreg(26); copyreg(27); copyreg(28);
copyreg(29); copyreg(30); copyreg(31);
#define copysreg(nm) __asm__ volatile ("mf" #nm " %0" : "=r"(f->nm))
copysreg(cr); copysreg(ctr); copysreg(xer);
#define copyfreg(x) __asm__ volatile ("stfd " #x ", %0" : "=m"(f->fp[x-14]))
copyfreg(14); copyfreg(15); copyfreg(16); copyfreg(17); copyfreg(18);
copyfreg(19); copyfreg(20); copyfreg(21); copyfreg(22); copyfreg(23);
copyfreg(24); copyfreg(25); copyfreg(26); copyfreg(27); copyfreg(28);
copyfreg(29); copyfreg(30); copyfreg(31);
__asm__ volatile ("mffs 0; stfd 0, %0" : "=m"(f->fs));
statep->frame = (int)f;
}
/*
* No-op float saves.
* (Floating point registers were saved in _thread_machdep_switch())
*/
void
_thread_machdep_save_float_state(statep)
struct _machdep_state* statep;
{
}
void
_thread_machdep_restore_float_state(statep)
struct _machdep_state* statep;
{
}
|
