#include <stdarg.h>
#include <string.h>
#include <errno.h>
#include "Pcontrol.h"
#pragma weak ps_pdread = ps_pread
#pragma weak ps_ptread = ps_pread
#pragma weak ps_pdwrite = ps_pwrite
#pragma weak ps_ptwrite = ps_pwrite
ps_err_e
ps_pdmodel(struct ps_prochandle *P, int *modelp)
{
*modelp = P->status.pr_dmodel;
return (PS_OK);
}
ps_err_e
ps_pread(struct ps_prochandle *P, psaddr_t addr, void *buf, size_t size)
{
if (P->ops.pop_pread(P, buf, size, addr, P->data) != size)
return (PS_BADADDR);
return (PS_OK);
}
ps_err_e
ps_pwrite(struct ps_prochandle *P, psaddr_t addr, const void *buf, size_t size)
{
if (P->ops.pop_pwrite(P, buf, size, addr, P->data) != size)
return (PS_BADADDR);
return (PS_OK);
}
ps_err_e
ps_pstop(struct ps_prochandle *P)
{
if (P->state != PS_STOP && P->state != PS_DEAD)
return (PS_ERR);
return (PS_OK);
}
ps_err_e
ps_pcontinue(struct ps_prochandle *P)
{
if (P->state != PS_STOP && P->state != PS_DEAD)
return (PS_ERR);
return (PS_OK);
}
ps_err_e
ps_lstop(struct ps_prochandle *P, lwpid_t lwpid)
{
if (P->state != PS_STOP && P->state != PS_DEAD)
return (PS_ERR);
return (PS_OK);
}
ps_err_e
ps_lcontinue(struct ps_prochandle *P, lwpid_t lwpid)
{
if (P->state != PS_STOP && P->state != PS_DEAD)
return (PS_ERR);
return (PS_OK);
}
ps_err_e
ps_lgetregs(struct ps_prochandle *P, lwpid_t lwpid, prgregset_t regs)
{
if (P->state != PS_STOP && P->state != PS_DEAD)
return (PS_ERR);
if (Plwp_getregs(P, lwpid, regs) == 0)
return (PS_OK);
return (PS_BADLID);
}
ps_err_e
ps_lsetregs(struct ps_prochandle *P, lwpid_t lwpid, const prgregset_t regs)
{
if (P->state != PS_STOP)
return (PS_ERR);
if (Plwp_setregs(P, lwpid, regs) == 0)
return (PS_OK);
return (PS_BADLID);
}
ps_err_e
ps_lgetfpregs(struct ps_prochandle *P, lwpid_t lwpid, prfpregset_t *regs)
{
if (P->state != PS_STOP && P->state != PS_DEAD)
return (PS_ERR);
if (Plwp_getfpregs(P, lwpid, regs) == 0)
return (PS_OK);
return (PS_BADLID);
}
ps_err_e
ps_lsetfpregs(struct ps_prochandle *P, lwpid_t lwpid, const prfpregset_t *regs)
{
if (P->state != PS_STOP)
return (PS_ERR);
if (Plwp_setfpregs(P, lwpid, regs) == 0)
return (PS_OK);
return (PS_BADLID);
}
ps_err_e
ps_lgetxregsize(struct ps_prochandle *P, lwpid_t lwpid, int *xrsize)
{
char fname[PATH_MAX];
struct stat statb;
if (P->state == PS_DEAD) {
core_info_t *core = P->data;
lwp_info_t *lwp;
for (lwp = list_head(&core->core_lwp_head); lwp != NULL;
lwp = list_next(&core->core_lwp_head, lwp)) {
if (lwp->lwp_id == lwpid) {
if (lwp->lwp_xregs != NULL &&
lwp->lwp_xregsize > 0) {
if (lwp->lwp_xregsize >= INT_MAX) {
return (PS_ERR);
}
*xrsize = (int)lwp->lwp_xregsize;
} else {
*xrsize = 0;
}
return (PS_OK);
}
}
return (PS_BADLID);
}
(void) snprintf(fname, sizeof (fname), "%s/%d/lwp/%d/xregs",
procfs_path, (int)P->status.pr_pid, (int)lwpid);
if (stat(fname, &statb) != 0)
return (PS_BADLID);
if (statb.st_size > INT_MAX)
return (PS_ERR);
*xrsize = (int)statb.st_size;
return (PS_OK);
}
ps_err_e
ps_lgetxregs(struct ps_prochandle *P, lwpid_t lwpid, caddr_t xregs)
{
size_t xregsize;
prxregset_t *prx;
if (P->state != PS_STOP && P->state != PS_DEAD)
return (PS_ERR);
if (Plwp_getxregs(P, lwpid, &prx, &xregsize) == 0) {
(void) memcpy(xregs, prx, xregsize);
Plwp_freexregs(P, prx, xregsize);
return (PS_OK);
}
if (errno == ENODATA)
return (PS_NOXREGS);
else if (errno == ENOENT)
return (PS_BADLID);
return (PS_ERR);
}
ps_err_e
ps_lsetxregs(struct ps_prochandle *P, lwpid_t lwpid, caddr_t xregs)
{
size_t xregsize = 0;
if (P->state != PS_STOP)
return (PS_ERR);
#if defined(__i386) || defined(__amd64)
prxregset_hdr_t *hdr = (prxregset_hdr_t *)xregs;
xregsize = hdr->pr_size;
#endif
if (Plwp_setxregs(P, lwpid, (prxregset_t *)xregs, xregsize) == 0)
return (PS_OK);
if (errno == ENOENT)
return (PS_BADLID);
return (PS_ERR);
}
#if defined(sparc) || defined(__sparc)
ps_err_e
ps_lsetxregs(struct ps_prochandle *P, lwpid_t lwpid, caddr_t xregs)
{
if (P->state != PS_STOP)
return (PS_ERR);
if (Plwp_setxregs(P, lwpid, (prxregset_t *)xregs) == 0)
return (PS_OK);
return (PS_BADLID);
}
#endif
#if defined(__i386) || defined(__amd64)
ps_err_e
ps_lgetLDT(struct ps_prochandle *P, lwpid_t lwpid, struct ssd *ldt)
{
#if defined(__amd64) && defined(_LP64)
if (P->status.pr_dmodel != PR_MODEL_NATIVE) {
#endif
prgregset_t regs;
struct ssd *ldtarray;
ps_err_e error;
uint_t gs;
int nldt;
int i;
if (P->state != PS_STOP && P->state != PS_DEAD)
return (PS_ERR);
if ((error = ps_lgetregs(P, lwpid, regs)) != PS_OK)
return (error);
gs = regs[GS];
if ((nldt = Pldt(P, NULL, 0)) <= 0 ||
(ldtarray = malloc(nldt * sizeof (struct ssd))) == NULL)
return (PS_ERR);
if ((nldt = Pldt(P, ldtarray, nldt)) <= 0) {
free(ldtarray);
return (PS_ERR);
}
for (i = 0; i < nldt; i++) {
if (gs == ldtarray[i].sel) {
*ldt = ldtarray[i];
break;
}
}
free(ldtarray);
if (i < nldt)
return (PS_OK);
#if defined(__amd64) && defined(_LP64)
}
#endif
return (PS_ERR);
}
#endif
void
ps_plog(const char *fmt, ...)
{
va_list ap;
if (_libproc_debug && fmt != NULL && *fmt != '\0') {
va_start(ap, fmt);
(void) vfprintf(stderr, fmt, ap);
va_end(ap);
if (fmt[strlen(fmt) - 1] != '\n')
(void) fputc('\n', stderr);
}
}
ps_err_e
ps_pauxv(struct ps_prochandle *P, const auxv_t **aux)
{
if (P->auxv == NULL)
Preadauxvec(P);
if (P->auxv == NULL)
return (PS_ERR);
*aux = (const auxv_t *)P->auxv;
return (PS_OK);
}
ps_err_e
ps_pbrandname(struct ps_prochandle *P, char *buf, size_t len)
{
return (Pbrandname(P, buf, len) ? PS_OK : PS_ERR);
}
ps_err_e
ps_pglobal_lookup(struct ps_prochandle *P, const char *object_name,
const char *sym_name, psaddr_t *sym_addr)
{
GElf_Sym sym;
if (Plookup_by_name(P, object_name, sym_name, &sym) == 0) {
Pdprintf("pglobal_lookup <%s> -> %p\n",
sym_name, (void *)(uintptr_t)sym.st_value);
*sym_addr = (psaddr_t)sym.st_value;
return (PS_OK);
}
return (PS_NOSYM);
}
ps_err_e
ps_pglobal_sym(struct ps_prochandle *P, const char *object_name,
const char *sym_name, ps_sym_t *symp)
{
#if defined(_ILP32)
GElf_Sym sym;
if (Plookup_by_name(P, object_name, sym_name, &sym) == 0) {
symp->st_name = (Elf32_Word)sym.st_name;
symp->st_value = (Elf32_Addr)sym.st_value;
symp->st_size = (Elf32_Word)sym.st_size;
symp->st_info = ELF32_ST_INFO(
GELF_ST_BIND(sym.st_info), GELF_ST_TYPE(sym.st_info));
symp->st_other = sym.st_other;
symp->st_shndx = sym.st_shndx;
return (PS_OK);
}
#elif defined(_LP64)
if (Plookup_by_name(P, object_name, sym_name, symp) == 0)
return (PS_OK);
#endif
return (PS_NOSYM);
}