#include "opt_platform.h"
#include <sys/param.h>
#include <sys/malloc.h>
#ifdef FDT
#include <dev/ofw/ofw_bus.h>
#include <dev/ofw/ofw_bus_subr.h>
#endif
#include <dev/hwreset/hwreset.h>
MALLOC_DECLARE(M_HWRESET);
struct hwreset_array {
hwreset_t *rst_array;
int count;
};
int
hwreset_array_assert(hwreset_array_t rsts)
{
int i, rv;
for (i = 0; i < rsts->count; i++) {
rv = hwreset_assert(rsts->rst_array[i]);
if (rv != 0)
return (rv);
}
return (0);
}
int
hwreset_array_deassert(hwreset_array_t rsts)
{
int i, rv;
for (i = 0; i < rsts->count; i++) {
rv = hwreset_deassert(rsts->rst_array[i]);
if (rv != 0)
return (rv);
}
return (0);
}
void
hwreset_array_release(hwreset_array_t rsts)
{
int i;
for (i = 0; i < rsts->count; i++) {
hwreset_release(rsts->rst_array[i]);
}
free(rsts->rst_array, M_HWRESET);
free(rsts, M_HWRESET);
}
#ifdef FDT
int
hwreset_array_get_ofw(device_t consumer_dev, phandle_t cnode,
hwreset_array_t *rsts)
{
hwreset_array_t resets;
int count, i, rv;
if (cnode <= 0)
cnode = ofw_bus_get_node(consumer_dev);
if (cnode <= 0) {
device_printf(consumer_dev,
"%s called on not ofw based device\n", __func__);
return (ENXIO);
}
rv = ofw_bus_parse_xref_list_get_length(cnode, "resets", "#reset-cells",
&count);
if (rv != 0)
return (rv);
resets = malloc(sizeof(struct hwreset_array), M_HWRESET,
M_WAITOK | M_ZERO);
resets->rst_array = mallocarray(count, sizeof(hwreset_t), M_HWRESET,
M_WAITOK | M_ZERO);
for (i = 0; i < count; i++) {
rv = hwreset_get_by_ofw_idx(consumer_dev, cnode, i,
&resets->rst_array[i]);
if (rv != 0)
break;
}
if (rv != 0) {
count = i;
for (i = 0; i < count; i++) {
hwreset_release(resets->rst_array[i]);
}
free(resets->rst_array, M_HWRESET);
free(resets, M_HWRESET);
} else {
resets->count = count;
*rsts = resets;
}
return (rv);
}
#endif