#include <sys/avl.h>
#include <mdb/mdb_modapi.h>
struct aw_info {
void *aw_buff;
avl_tree_t aw_tree;
uintptr_t aw_end;
const char *aw_elem_name;
int (*aw_elem_check)(void *, uintptr_t, void *);
void *aw_elem_check_arg;
};
static uintptr_t
avl_leftmostchild(uintptr_t addr, void *buff, size_t offset, size_t size,
const char *elem_name)
{
avl_node_t *node = (avl_node_t *)((uintptr_t)buff + offset);
for (;;) {
addr -= offset;
if (mdb_vread(buff, size, addr) == -1) {
mdb_warn("failed to read %s at %#lx", elem_name, addr);
return ((uintptr_t)-1L);
}
if (node->avl_child[0] == NULL)
break;
addr = (uintptr_t)node->avl_child[0];
}
return (addr);
}
int
avl_walk_init_range(mdb_walk_state_t *wsp, uintptr_t begin, uintptr_t end,
const char *avl_name, const char *element_name,
int (*element_check)(void *, uintptr_t, void *), void *arg)
{
struct aw_info *aw;
avl_tree_t *tree;
uintptr_t addr;
if (avl_name == NULL)
avl_name = "avl_tree_t";
if (element_name == NULL)
element_name = "tree element";
wsp->walk_data = aw = mdb_zalloc(sizeof (struct aw_info), UM_SLEEP);
tree = &aw->aw_tree;
if (mdb_vread(tree, sizeof (avl_tree_t), wsp->walk_addr) == -1) {
mdb_warn("failed to read %s at %#lx", avl_name, wsp->walk_addr);
goto error;
}
if (tree->avl_size < tree->avl_offset + sizeof (avl_node_t)) {
mdb_warn("invalid avl_tree_t at %p, avl_size:%d, avl_offset:%d",
wsp->walk_addr, tree->avl_size, tree->avl_offset);
goto error;
}
aw->aw_buff = mdb_zalloc(tree->avl_size, UM_SLEEP);
aw->aw_end = (end == 0 ? 0 : end + tree->avl_offset);
aw->aw_elem_name = element_name;
aw->aw_elem_check = element_check;
aw->aw_elem_check_arg = arg;
if (begin == 0) {
addr = (uintptr_t)tree->avl_root;
if (addr == 0) {
wsp->walk_addr = 0;
return (WALK_NEXT);
}
addr = avl_leftmostchild(addr, aw->aw_buff, tree->avl_offset,
tree->avl_size, aw->aw_elem_name);
if (addr == (uintptr_t)-1L)
goto error;
wsp->walk_addr = addr;
} else {
wsp->walk_addr = begin + tree->avl_offset;
}
return (WALK_NEXT);
error:
if (aw->aw_buff != NULL)
mdb_free(aw->aw_buff, sizeof (tree->avl_size));
mdb_free(aw, sizeof (struct aw_info));
return (WALK_ERR);
}
int
avl_walk_init(mdb_walk_state_t *wsp)
{
return (avl_walk_init_range(wsp, 0, 0, NULL, NULL, NULL, NULL));
}
int
avl_walk_init_named(mdb_walk_state_t *wsp,
const char *avl_name, const char *element_name)
{
return (avl_walk_init_range(wsp, 0, 0, avl_name, element_name,
NULL, NULL));
}
int
avl_walk_init_checked(mdb_walk_state_t *wsp,
const char *avl_name, const char *element_name,
int (*element_check)(void *, uintptr_t, void *), void *arg)
{
return (avl_walk_init_range(wsp, 0, 0, avl_name, element_name,
element_check, arg));
}
int
avl_walk_step(mdb_walk_state_t *wsp)
{
struct aw_info *aw;
size_t offset;
size_t size;
uintptr_t addr;
avl_node_t *node;
int status;
int was_child;
addr = wsp->walk_addr;
if (addr == 0)
return (WALK_DONE);
aw = (struct aw_info *)wsp->walk_data;
if (aw->aw_end != 0 && wsp->walk_addr == aw->aw_end)
return (WALK_DONE);
size = aw->aw_tree.avl_size;
offset = aw->aw_tree.avl_offset;
node = (avl_node_t *)((uintptr_t)aw->aw_buff + offset);
if (mdb_vread(aw->aw_buff, size, addr) == -1) {
mdb_warn("failed to read %s at %#lx", aw->aw_elem_name, addr);
return (WALK_ERR);
}
if (aw->aw_elem_check != NULL) {
int rc = aw->aw_elem_check(aw->aw_buff, addr,
aw->aw_elem_check_arg);
if (rc == -1)
return (WALK_ERR);
else if (rc == 1)
return (WALK_DONE);
}
status = wsp->walk_callback(addr, aw->aw_buff, wsp->walk_cbdata);
if (status != WALK_NEXT)
return (status);
addr = (uintptr_t)node->avl_child[1];
if (addr != 0) {
addr = avl_leftmostchild(addr, aw->aw_buff, offset, size,
aw->aw_elem_name);
if (addr == (uintptr_t)-1L)
return (WALK_ERR);
} else {
for (;;) {
was_child = AVL_XCHILD(node);
addr = (uintptr_t)AVL_XPARENT(node);
if (addr == 0)
break;
addr -= offset;
if (was_child == 0)
break;
if (mdb_vread(aw->aw_buff, size, addr) == -1) {
mdb_warn("failed to read %s at %#lx",
aw->aw_elem_name, addr);
return (WALK_ERR);
}
}
}
wsp->walk_addr = addr;
return (WALK_NEXT);
}
void
avl_walk_fini(mdb_walk_state_t *wsp)
{
struct aw_info *aw;
aw = (struct aw_info *)wsp->walk_data;
if (aw == NULL)
return;
if (aw->aw_buff != NULL)
mdb_free(aw->aw_buff, aw->aw_tree.avl_size);
mdb_free(aw, sizeof (struct aw_info));
}
int
avl_walk_mdb(uintptr_t addr, mdb_walk_cb_t callback, void *cbdata)
{
mdb_walk_state_t ws;
int ret;
ws.walk_addr = addr;
ws.walk_callback = callback;
ws.walk_cbdata = cbdata;
avl_walk_init(&ws);
while ((ret = avl_walk_step(&ws)) == WALK_NEXT)
continue;
avl_walk_fini(&ws);
return (ret);
}