/*	$OpenBSD: fpu_reg.c,v 1.1 2003/07/21 18:41:30 jason Exp $	*/

/*
 * Copyright (c) 2003 Jason L. Wright (jason@thought.net)
 * All rights reserved.
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions
 * are met:
 * 1. Redistributions of source code must retain the above copyright
 *    notice, this list of conditions and the following disclaimer.
 * 2. Redistributions in binary form must reproduce the above copyright
 *    notice, this list of conditions and the following disclaimer in the
 *    documentation and/or other materials provided with the distribution.
 *
 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
 * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
 * DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT,
 * INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
 * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
 * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT,
 * STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
 * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
 * POSSIBILITY OF SUCH DAMAGE.
 */
#include <sys/types.h>
#include "fpu_reg.h"

void
__fpu_setreg32(int r, u_int32_t v)
{
	switch (r) {
	case 0:
		asm("ld [%0], %%f0" : : "r" (&v));
		break;
	case 1:
		asm("ld [%0], %%f1" : : "r" (&v));
		break;
	case 2:
		asm("ld [%0], %%f2" : : "r" (&v));
		break;
	case 3:
		asm("ld [%0], %%f3" : : "r" (&v));
		break;
	case 4:
		asm("ld [%0], %%f4" : : "r" (&v));
		break;
	case 5:
		asm("ld [%0], %%f5" : : "r" (&v));
		break;
	case 6:
		asm("ld [%0], %%f6" : : "r" (&v));
		break;
	case 7:
		asm("ld [%0], %%f7" : : "r" (&v));
		break;
	case 8:
		asm("ld [%0], %%f8" : : "r" (&v));
		break;
	case 9:
		asm("ld [%0], %%f9" : : "r" (&v));
		break;
	case 10:
		asm("ld [%0], %%f10" : : "r" (&v));
		break;
	case 11:
		asm("ld [%0], %%f11" : : "r" (&v));
		break;
	case 12:
		asm("ld [%0], %%f12" : : "r" (&v));
		break;
	case 13:
		asm("ld [%0], %%f13" : : "r" (&v));
		break;
	case 14:
		asm("ld [%0], %%f14" : : "r" (&v));
		break;
	case 15:
		asm("ld [%0], %%f15" : : "r" (&v));
		break;
	case 16:
		asm("ld [%0], %%f16" : : "r" (&v));
		break;
	case 17:
		asm("ld [%0], %%f17" : : "r" (&v));
		break;
	case 18:
		asm("ld [%0], %%f18" : : "r" (&v));
		break;
	case 19:
		asm("ld [%0], %%f19" : : "r" (&v));
		break;
	case 20:
		asm("ld [%0], %%f20" : : "r" (&v));
		break;
	case 21:
		asm("ld [%0], %%f21" : : "r" (&v));
		break;
	case 22:
		asm("ld [%0], %%f22" : : "r" (&v));
		break;
	case 23:
		asm("ld [%0], %%f23" : : "r" (&v));
		break;
	case 24:
		asm("ld [%0], %%f24" : : "r" (&v));
		break;
	case 25:
		asm("ld [%0], %%f25" : : "r" (&v));
		break;
	case 26:
		asm("ld [%0], %%f26" : : "r" (&v));
		break;
	case 27:
		asm("ld [%0], %%f27" : : "r" (&v));
		break;
	case 28:
		asm("ld [%0], %%f28" : : "r" (&v));
		break;
	case 29:
		asm("ld [%0], %%f29" : : "r" (&v));
		break;
	case 30:
		asm("ld [%0], %%f30" : : "r" (&v));
		break;
	case 31:
		asm("ld [%0], %%f31" : : "r" (&v));
		break;
	case 32:
		asm("ld [%0], %%f32" : : "r" (&v));
		break;
	case 33:
		asm("ld [%0], %%f33" : : "r" (&v));
		break;
	case 34:
		asm("ld [%0], %%f34" : : "r" (&v));
		break;
	case 35:
		asm("ld [%0], %%f35" : : "r" (&v));
		break;
	case 36:
		asm("ld [%0], %%f36" : : "r" (&v));
		break;
	case 37:
		asm("ld [%0], %%f37" : : "r" (&v));
		break;
	case 38:
		asm("ld [%0], %%f38" : : "r" (&v));
		break;
	case 39:
		asm("ld [%0], %%f39" : : "r" (&v));
		break;
	case 40:
		asm("ld [%0], %%f40" : : "r" (&v));
		break;
	case 41:
		asm("ld [%0], %%f41" : : "r" (&v));
		break;
	case 42:
		asm("ld [%0], %%f42" : : "r" (&v));
		break;
	case 43:
		asm("ld [%0], %%f43" : : "r" (&v));
		break;
	case 44:
		asm("ld [%0], %%f44" : : "r" (&v));
		break;
	case 45:
		asm("ld [%0], %%f45" : : "r" (&v));
		break;
	case 46:
		asm("ld [%0], %%f46" : : "r" (&v));
		break;
	case 47:
		asm("ld [%0], %%f47" : : "r" (&v));
		break;
	case 48:
		asm("ld [%0], %%f48" : : "r" (&v));
		break;
	case 49:
		asm("ld [%0], %%f49" : : "r" (&v));
		break;
	case 50:
		asm("ld [%0], %%f50" : : "r" (&v));
		break;
	case 51:
		asm("ld [%0], %%f51" : : "r" (&v));
		break;
	case 52:
		asm("ld [%0], %%f52" : : "r" (&v));
		break;
	case 53:
		asm("ld [%0], %%f53" : : "r" (&v));
		break;
	case 54:
		asm("ld [%0], %%f54" : : "r" (&v));
		break;
	case 55:
		asm("ld [%0], %%f55" : : "r" (&v));
		break;
	case 56:
		asm("ld [%0], %%f56" : : "r" (&v));
		break;
	case 57:
		asm("ld [%0], %%f57" : : "r" (&v));
		break;
	case 58:
		asm("ld [%0], %%f58" : : "r" (&v));
		break;
	case 59:
		asm("ld [%0], %%f59" : : "r" (&v));
		break;
	case 60:
		asm("ld [%0], %%f60" : : "r" (&v));
		break;
	case 61:
		asm("ld [%0], %%f61" : : "r" (&v));
		break;
	case 62:
		asm("ld [%0], %%f62" : : "r" (&v));
		break;
	case 63:
		asm("ld [%0], %%f63" : : "r" (&v));
		break;
	}
}

void
__fpu_setreg64(int r, u_int64_t v)
{
	switch (r) {
	case 0:
		asm("ldd [%0], %%f0" : : "r" (&v));
		break;
	case 2:
		asm("ldd [%0], %%f2" : : "r" (&v));
		break;
	case 4:
		asm("ldd [%0], %%f4" : : "r" (&v));
		break;
	case 6:
		asm("ldd [%0], %%f6" : : "r" (&v));
		break;
	case 8:
		asm("ldd [%0], %%f8" : : "r" (&v));
		break;
	case 10:
		asm("ldd [%0], %%f10" : : "r" (&v));
		break;
	case 12:
		asm("ldd [%0], %%f12" : : "r" (&v));
		break;
	case 14:
		asm("ldd [%0], %%f14" : : "r" (&v));
		break;
	case 16:
		asm("ldd [%0], %%f16" : : "r" (&v));
		break;
	case 18:
		asm("ldd [%0], %%f18" : : "r" (&v));
		break;
	case 20:
		asm("ldd [%0], %%f20" : : "r" (&v));
		break;
	case 22:
		asm("ldd [%0], %%f22" : : "r" (&v));
		break;
	case 24:
		asm("ldd [%0], %%f24" : : "r" (&v));
		break;
	case 26:
		asm("ldd [%0], %%f26" : : "r" (&v));
		break;
	case 28:
		asm("ldd [%0], %%f28" : : "r" (&v));
		break;
	case 30:
		asm("ldd [%0], %%f30" : : "r" (&v));
		break;
	case 32:
		asm("ldd [%0], %%f32" : : "r" (&v));
		break;
	case 34:
		asm("ldd [%0], %%f34" : : "r" (&v));
		break;
	case 36:
		asm("ldd [%0], %%f36" : : "r" (&v));
		break;
	case 38:
		asm("ldd [%0], %%f38" : : "r" (&v));
		break;
	case 40:
		asm("ldd [%0], %%f40" : : "r" (&v));
		break;
	case 42:
		asm("ldd [%0], %%f42" : : "r" (&v));
		break;
	case 44:
		asm("ldd [%0], %%f44" : : "r" (&v));
		break;
	case 46:
		asm("ldd [%0], %%f46" : : "r" (&v));
		break;
	case 48:
		asm("ldd [%0], %%f48" : : "r" (&v));
		break;
	case 50:
		asm("ldd [%0], %%f50" : : "r" (&v));
		break;
	case 52:
		asm("ldd [%0], %%f52" : : "r" (&v));
		break;
	case 54:
		asm("ldd [%0], %%f54" : : "r" (&v));
		break;
	case 56:
		asm("ldd [%0], %%f56" : : "r" (&v));
		break;
	case 58:
		asm("ldd [%0], %%f58" : : "r" (&v));
		break;
	case 60:
		asm("ldd [%0], %%f60" : : "r" (&v));
		break;
	case 62:
		asm("ldd [%0], %%f62" : : "r" (&v));
		break;
	}
}

u_int32_t
__fpu_getreg32(int r)
{
	u_int32_t v;

	switch (r) {
	case 0:
		asm("st %%f0, [%0]" : : "r" (&v));
		break;
	case 1:
		asm("st %%f1, [%0]" : : "r" (&v));
		break;
	case 2:
		asm("st %%f2, [%0]" : : "r" (&v));
		break;
	case 3:
		asm("st %%f3, [%0]" : : "r" (&v));
		break;
	case 4:
		asm("st %%f4, [%0]" : : "r" (&v));
		break;
	case 5:
		asm("st %%f5, [%0]" : : "r" (&v));
		break;
	case 6:
		asm("st %%f6, [%0]" : : "r" (&v));
		break;
	case 7:
		asm("st %%f7, [%0]" : : "r" (&v));
		break;
	case 8:
		asm("st %%f8, [%0]" : : "r" (&v));
		break;
	case 9:
		asm("st %%f9, [%0]" : : "r" (&v));
		break;
	case 10:
		asm("st %%f10, [%0]" : : "r" (&v));
		break;
	case 11:
		asm("st %%f11, [%0]" : : "r" (&v));
		break;
	case 12:
		asm("st %%f12, [%0]" : : "r" (&v));
		break;
	case 13:
		asm("st %%f13, [%0]" : : "r" (&v));
		break;
	case 14:
		asm("st %%f14, [%0]" : : "r" (&v));
		break;
	case 15:
		asm("st %%f15, [%0]" : : "r" (&v));
		break;
	case 16:
		asm("st %%f16, [%0]" : : "r" (&v));
		break;
	case 17:
		asm("st %%f17, [%0]" : : "r" (&v));
		break;
	case 18:
		asm("st %%f18, [%0]" : : "r" (&v));
		break;
	case 19:
		asm("st %%f19, [%0]" : : "r" (&v));
		break;
	case 20:
		asm("st %%f20, [%0]" : : "r" (&v));
		break;
	case 21:
		asm("st %%f21, [%0]" : : "r" (&v));
		break;
	case 22:
		asm("st %%f22, [%0]" : : "r" (&v));
		break;
	case 23:
		asm("st %%f23, [%0]" : : "r" (&v));
		break;
	case 24:
		asm("st %%f24, [%0]" : : "r" (&v));
		break;
	case 25:
		asm("st %%f25, [%0]" : : "r" (&v));
		break;
	case 26:
		asm("st %%f26, [%0]" : : "r" (&v));
		break;
	case 27:
		asm("st %%f27, [%0]" : : "r" (&v));
		break;
	case 28:
		asm("st %%f28, [%0]" : : "r" (&v));
		break;
	case 29:
		asm("st %%f29, [%0]" : : "r" (&v));
		break;
	case 30:
		asm("st %%f30, [%0]" : : "r" (&v));
		break;
	case 31:
		asm("st %%f31, [%0]" : : "r" (&v));
		break;
	case 32:
		asm("st %%f32, [%0]" : : "r" (&v));
		break;
	case 33:
		asm("st %%f33, [%0]" : : "r" (&v));
		break;
	case 34:
		asm("st %%f34, [%0]" : : "r" (&v));
		break;
	case 35:
		asm("st %%f35, [%0]" : : "r" (&v));
		break;
	case 36:
		asm("st %%f36, [%0]" : : "r" (&v));
		break;
	case 37:
		asm("st %%f37, [%0]" : : "r" (&v));
		break;
	case 38:
		asm("st %%f38, [%0]" : : "r" (&v));
		break;
	case 39:
		asm("st %%f39, [%0]" : : "r" (&v));
		break;
	case 40:
		asm("st %%f40, [%0]" : : "r" (&v));
		break;
	case 41:
		asm("st %%f41, [%0]" : : "r" (&v));
		break;
	case 42:
		asm("st %%f42, [%0]" : : "r" (&v));
		break;
	case 43:
		asm("st %%f43, [%0]" : : "r" (&v));
		break;
	case 44:
		asm("st %%f44, [%0]" : : "r" (&v));
		break;
	case 45:
		asm("st %%f45, [%0]" : : "r" (&v));
		break;
	case 46:
		asm("st %%f46, [%0]" : : "r" (&v));
		break;
	case 47:
		asm("st %%f47, [%0]" : : "r" (&v));
		break;
	case 48:
		asm("st %%f48, [%0]" : : "r" (&v));
		break;
	case 49:
		asm("st %%f49, [%0]" : : "r" (&v));
		break;
	case 50:
		asm("st %%f50, [%0]" : : "r" (&v));
		break;
	case 51:
		asm("st %%f51, [%0]" : : "r" (&v));
		break;
	case 52:
		asm("st %%f52, [%0]" : : "r" (&v));
		break;
	case 53:
		asm("st %%f53, [%0]" : : "r" (&v));
		break;
	case 54:
		asm("st %%f54, [%0]" : : "r" (&v));
		break;
	case 55:
		asm("st %%f55, [%0]" : : "r" (&v));
		break;
	case 56:
		asm("st %%f56, [%0]" : : "r" (&v));
		break;
	case 57:
		asm("st %%f57, [%0]" : : "r" (&v));
		break;
	case 58:
		asm("st %%f58, [%0]" : : "r" (&v));
		break;
	case 59:
		asm("st %%f59, [%0]" : : "r" (&v));
		break;
	case 60:
		asm("st %%f60, [%0]" : : "r" (&v));
		break;
	case 61:
		asm("st %%f61, [%0]" : : "r" (&v));
		break;
	case 62:
		asm("st %%f62, [%0]" : : "r" (&v));
		break;
	case 63:
		asm("st %%f63, [%0]" : : "r" (&v));
		break;
	}
	return (v);
}

u_int64_t
__fpu_getreg64(int r)
{
	u_int64_t v;

	switch (r) {
	case 0:
		asm("std %%f0, [%0]" : : "r" (&v));
		break;
	case 2:
		asm("std %%f2, [%0]" : : "r" (&v));
		break;
	case 4:
		asm("std %%f4, [%0]" : : "r" (&v));
		break;
	case 6:
		asm("std %%f6, [%0]" : : "r" (&v));
		break;
	case 8:
		asm("std %%f8, [%0]" : : "r" (&v));
		break;
	case 10:
		asm("std %%f10, [%0]" : : "r" (&v));
		break;
	case 12:
		asm("std %%f12, [%0]" : : "r" (&v));
		break;
	case 14:
		asm("std %%f14, [%0]" : : "r" (&v));
		break;
	case 16:
		asm("std %%f16, [%0]" : : "r" (&v));
		break;
	case 18:
		asm("std %%f18, [%0]" : : "r" (&v));
		break;
	case 20:
		asm("std %%f20, [%0]" : : "r" (&v));
		break;
	case 22:
		asm("std %%f22, [%0]" : : "r" (&v));
		break;
	case 24:
		asm("std %%f24, [%0]" : : "r" (&v));
		break;
	case 26:
		asm("std %%f26, [%0]" : : "r" (&v));
		break;
	case 28:
		asm("std %%f28, [%0]" : : "r" (&v));
		break;
	case 30:
		asm("std %%f30, [%0]" : : "r" (&v));
		break;
	case 32:
		asm("std %%f32, [%0]" : : "r" (&v));
		break;
	case 34:
		asm("std %%f34, [%0]" : : "r" (&v));
		break;
	case 36:
		asm("std %%f36, [%0]" : : "r" (&v));
		break;
	case 38:
		asm("std %%f38, [%0]" : : "r" (&v));
		break;
	case 40:
		asm("std %%f40, [%0]" : : "r" (&v));
		break;
	case 42:
		asm("std %%f42, [%0]" : : "r" (&v));
		break;
	case 44:
		asm("std %%f44, [%0]" : : "r" (&v));
		break;
	case 46:
		asm("std %%f46, [%0]" : : "r" (&v));
		break;
	case 48:
		asm("std %%f48, [%0]" : : "r" (&v));
		break;
	case 50:
		asm("std %%f50, [%0]" : : "r" (&v));
		break;
	case 52:
		asm("std %%f52, [%0]" : : "r" (&v));
		break;
	case 54:
		asm("std %%f54, [%0]" : : "r" (&v));
		break;
	case 56:
		asm("std %%f56, [%0]" : : "r" (&v));
		break;
	case 58:
		asm("std %%f58, [%0]" : : "r" (&v));
		break;
	case 60:
		asm("std %%f60, [%0]" : : "r" (&v));
		break;
	case 62:
		asm("std %%f62, [%0]" : : "r" (&v));
		break;
	}
	return (v);
}