summaryrefslogtreecommitdiff
path: root/lib/libpthread/arch/m88k/uthread_machdep.c
blob: 435e976d04ee212b9b4bd290f617715eae89232b (plain)
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
/*	$OpenBSD: uthread_machdep.c,v 1.1 2004/02/27 22:19:46 deraadt Exp $	*/

/*
 * Copyright (c) 2004 Theo de Raadt
 *
 * Permission to use, copy, modify, and distribute this software for any
 * purpose with or without fee is hereby granted, provided that the above
 * copyright notice and this permission notice appear in all copies.
 *
 * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
 * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
 * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
 * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
 * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
 * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
 * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
 */

/*
 * Machine-dependent thread state functions for m88k
 */

#include <pthread.h>
#include "pthread_private.h"

#define ALIGNBYTES	7

struct frame {
	long	regs[30];
};

/*
 * 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;

	f = (struct frame *)(((u_int32_t)base + len - sizeof *f) & ~ALIGNBYTES);
	f->regs[29] = f->regs[27] = (u_int32_t)entry;

	statep->sp = (int)f;
}

void
_thread_machdep_save_float_state(statep)
	struct _machdep_state* statep;
{
	int fpreg;

	__asm__ __volatile__ ("fldcr %0, fcr62" : "=r" (fpreg));
	statep->fpsr = fpreg;
	__asm__ __volatile__ ("fldcr %0, fcr63" : "=r" (fpreg));
	statep->fpcr = fpreg;
}

void
_thread_machdep_restore_float_state(statep)
	struct _machdep_state* statep;
{
	int fpreg;

	fpreg = statep->fpsr;
	__asm__ __volatile__ ("fstcr %0, fcr62" : : "r" (fpreg));
	fpreg = statep->fpcr;
	__asm__ __volatile__ ("fstcr %0, fcr63" : : "r" (fpreg));
}