NetBSD/sys/arch/ia64/unwind/decode.c

342 lines
5.9 KiB
C

/* $NetBSD: decode.c,v 1.2 2006/11/24 21:20:05 wiz Exp $ */
/* Contributed to the NetBSD foundation by Cherry G. Mathew
* This file contains routines to decode unwind descriptors into
* easily an readable data structure ( unwind_desc )
* This is the lowest layer of the unwind stack hierarchy.
*/
#include <sys/cdefs.h>
#include <sys/types.h>
#include <sys/param.h>
#include <sys/systm.h>
#include <ia64/unwind/decode.h>
/* Decode ULE128 string */
char *
unwind_decode_ule128(char *buf, unsigned long *val)
{
int i = 0;
val[0] = 0;
do {
val[0] += ((buf[i] & 0x7f) << (i * 7));
}while((0x80 & buf[i++]) && (i < 9));
if(i > 9) {
printf("Warning: ULE128 won't fit in an unsigned long. decode aborted!!!\n");
return 0;
}
buf+= i;
return buf;
}
char *
unwind_decode_R1(char *buf, union unwind_desc *uwd)
{
if(!IS_R1(buf[0])) return NULL;
uwd->R1.r = ((buf[0] & 0x20) == 0x20);
uwd->R1.rlen = (buf[0] & 0x1f);
buf++;
return buf;
}
char *
unwind_decode_R2(char *buf, union unwind_desc *uwd)
{
if(!IS_R2(buf[0])) return NULL;
uwd->R2.mask = (((buf[0] & 0x07) << 1) | ( (buf[1] >> 7) & 0xff));
uwd->R2.grsave = (buf[1] & 0x7f);
buf += 2;
buf = unwind_decode_ule128(buf, &uwd->R2.rlen);
return buf;
}
char *
unwind_decode_R3(char *buf, union unwind_desc *uwd)
{
if(!IS_R3(buf[0])) return NULL;
uwd->R3.r = ((buf[0] & 0x03) == 0x01);
buf++;
buf = unwind_decode_ule128(buf, &uwd->R3.rlen);
return buf;
}
char *
unwind_decode_P1(char *buf, union unwind_desc *uwd)
{
if(!IS_P1(buf[0])) return NULL;
uwd->P1.brmask = (buf[0] & 0x1f);
buf++;
return buf;
}
char *
unwind_decode_P2(char *buf, union unwind_desc *uwd)
{
if(!IS_P2(buf[0])) return NULL;
uwd->P2.brmask = (((buf[0] & 0x0f) << 1) | ( (buf[1] >> 7) & 0xff));
uwd->P2.gr = (buf[1] & 0x7f);
buf += 2;
return buf;
}
char *
unwind_decode_P3(char *buf, union unwind_desc *uwd)
{
if(!IS_P3(buf[0])) return NULL;
uwd->P3.r = (((0x07 & buf[0]) << 1) | ((0x80 & buf[1]) >> 7));
uwd->P3.grbr = (buf[1] & 0x7f);
buf +=2;
return buf;
}
char *
unwind_decode_P4(char *buf, union unwind_desc *uwd, vsize_t len)
{
if(!IS_P4(buf[0])) return NULL;
uwd->P4.imask = 0; /* XXX: Unimplemented */
/* XXX: adjust buf for imask length on return!!!
* don't know the length of imask here.
*/
buf += roundup(len << 1, 8);
return buf;
}
char *
unwind_decode_P5(char *buf, union unwind_desc *uwd)
{
if(!IS_P5(buf[0])) return NULL;
uwd->P5.grmask = (buf[1] >> 4);
uwd->P5.frmask = ((buf[1] & 0x0f << 16) | (buf[2] << 8) | buf[3]);
buf += 4;
return buf;
}
char *
unwind_decode_P6(char *buf, union unwind_desc *uwd)
{
if(!IS_P6(buf[0])) return NULL;
uwd->P6.r = ((buf[0] & 0x10) == 0x10);
uwd->P6.rmask = (buf[0] & 0x0f);
buf++;
return buf;
}
char *
unwind_decode_P7(char *buf, union unwind_desc *uwd)
{
if (!IS_P7(buf[0])) return NULL;
uwd->P7.r = (buf[0] & 0x0f);
buf++;
buf = unwind_decode_ule128(buf, &uwd->P7.t);
if (uwd->P7.r == 0) /* memstack_f */
buf = unwind_decode_ule128(buf, &uwd->P7.size);
return buf;
}
char *
unwind_decode_P8(char *buf, union unwind_desc *uwd)
{
if(!IS_P8(buf[0])) return NULL;
uwd->P8.r = buf[1];
buf +=2;
buf = unwind_decode_ule128(buf, &uwd->P8.t);
return buf;
}
char *
unwind_decode_P9(char *buf, union unwind_desc *uwd)
{
if(!IS_P9(buf[0])) return NULL;
uwd->P9.grmask = buf[1] & 0x0f;
uwd->P9.gr = buf[2] & 0x7f;
buf += 3;
return buf;
}
char *
unwind_decode_P10(char *buf, union unwind_desc *uwd)
{
if(!IS_P10(buf[0])) return NULL;
uwd->P10.abi = buf[1];
uwd->P10.context = buf[2];
buf += 3;
return buf;
}
char *
unwind_decode_B1(char *buf, union unwind_desc *uwd)
{
if(!IS_B1(buf[0])) return NULL;
uwd->B1.r = ((buf[0] & 0x20) == 0x20);
uwd->B1.label = (buf[0] & 0x1f);
buf++;
return buf;
}
char *
unwind_decode_B2(char *buf, union unwind_desc *uwd)
{
if(!IS_B2(buf[0])) return NULL;
uwd->B2.ecount = (buf[0] & 0x1f);
buf++;
buf = unwind_decode_ule128(buf, &uwd->B2.t);
return buf;
}
char *
unwind_decode_B3(char *buf, union unwind_desc *uwd)
{
if(!IS_B3(buf[0])) return NULL;
buf++;
buf = unwind_decode_ule128(buf, &uwd->B3.t);
buf = unwind_decode_ule128(buf, &uwd->B3.ecount);
return buf;
}
char *
unwind_decode_B4(char *buf, union unwind_desc *uwd)
{
if(!IS_B4(buf[0])) return NULL;
uwd->B4.r = ((buf[0] & 0x08) == 0x08);
buf++;
buf = unwind_decode_ule128(buf, &uwd->B4.label);
return buf;
}
char *
unwind_decode_X1(char *buf, union unwind_desc *uwd)
{
if(!IS_X1(buf[0])) return NULL;
uwd->X1.r = ((buf[1] & 0x80) == 0x80);
uwd->X1.a = ((buf[1] & 0x40) == 0x40);
uwd->X1.b = ((buf[1] & 0x20) == 0x20);
uwd->X1.reg = (buf[1] & 0x1f);
buf += 2;
buf = unwind_decode_ule128(buf, &uwd->X1.t);
buf = unwind_decode_ule128(buf, &uwd->X1.offset);
return buf;
}
char *
unwind_decode_X2(char *buf, union unwind_desc *uwd)
{
if(!IS_X2(buf[0])) return NULL;
uwd->X2.x = ((buf[1] & 0x80) == 0x80);
uwd->X2.a = ((buf[1] & 0x40) == 0x40);
uwd->X2.b = ((buf[1] & 0x20) == 0x20);
uwd->X2.reg = (buf[1] & 0x1f);
uwd->X2.y = ((buf[2] & 0x80) == 0x80);
uwd->X2.treg = (buf[2] & 0x7f);
buf += 3;
buf = unwind_decode_ule128(buf, &uwd->X2.t);
return buf;
}
char *
unwind_decode_X3(char *buf, union unwind_desc *uwd)
{
if(!IS_X3(buf[0])) return NULL;
uwd->X3.r = ((buf[1] & 0x80) == 0x80);
uwd->X3.qp = (buf[1] & 0x3f);
uwd->X3.a = ((buf[1] & 0x40) == 0x40);
uwd->X3.b = ((buf[1] & 0x20) == 0x20);
uwd->X3.reg = (buf[1] & 0x1f);
buf += 3;
buf = unwind_decode_ule128(buf, &uwd->X3.t);
buf = unwind_decode_ule128(buf, &uwd->X3.offset );
return buf;
}
char *
unwind_decode_X4(char *buf, union unwind_desc *uwd)
{
if(!IS_X4(buf[0])) return NULL;
uwd->X4.qp = (buf[1] & 0x3f);
uwd->X4.x = ((buf[2] & 0x80) == 0x80);
uwd->X4.a = ((buf[2] & 0x40) == 0x40);
uwd->X4.b = ((buf[2] & 0x20) == 0x20);
uwd->X4.reg = (buf[2] & 0x1f);
uwd->X4.y = ((buf[3] & 0x80) == 0x80);
uwd->X4.treg = (buf[3] & 0x7f);
buf +=4;
buf = unwind_decode_ule128(buf, &uwd->X4.t);
return buf;
}