#include <sys/cdefs.h>
__KERNEL_RCSID(0, "$NetBSD: arcbios.c,v 1.13 2011/02/20 08:02:46 matt Exp $");
#include <sys/param.h>
#include <sys/systm.h>
#include <dev/cons.h>
#include <sys/conf.h>
#include <dev/arcbios/arcbios.h>
#include <dev/arcbios/arcbiosvar.h>
const struct arcbios_spb *ARCBIOS_SPB;
const struct arcbios_fv *ARCBIOS;
char arcbios_sysid_vendor[ARCBIOS_SYSID_FIELDLEN + 1];
char arcbios_sysid_product[ARCBIOS_SYSID_FIELDLEN + 1];
char arcbios_system_identifier[64 + 1];
int arcbios_cngetc(dev_t);
void arcbios_cnputc(dev_t, int);
void arcbios_fetch_system_identifier(struct arcbios_component *,
struct arcbios_treewalk_context *);
struct consdev arcbios_cn = {
NULL, NULL, arcbios_cngetc, arcbios_cnputc, nullcnpollc,
NULL, NULL, NULL, NODEV, CN_NORMAL,
};
extern const struct cdevsw arcbios_cdevsw;
int
arcbios_init(vaddr_t pblkva)
{
int maj;
struct arcbios_sysid *sid;
ARCBIOS_SPB = (struct arcbios_spb *) pblkva;
switch (ARCBIOS_SPB->SPBSignature) {
case ARCBIOS_SPB_SIGNATURE:
case ARCBIOS_SPB_SIGNATURE_1:
break;
default:
return (1);
}
ARCBIOS = (void *)(intptr_t)ARCBIOS_SPB->FirmwareVector;
maj = cdevsw_lookup_major(&arcbios_cdevsw);
arcbios_cn.cn_dev = makedev(maj, 0);
cn_tab = &arcbios_cn;
sid = arcbios_GetSystemId();
if (sid != NULL) {
memcpy(arcbios_sysid_vendor, sid->VendorId,
sizeof(sid->VendorId));
arcbios_sysid_vendor[sizeof(sid->VendorId)] = '\0';
memcpy(arcbios_sysid_product, sid->ProductId,
sizeof(sid->ProductId));
arcbios_sysid_product[sizeof(sid->ProductId)] = '\0';
}
arcbios_tree_walk(arcbios_fetch_system_identifier, NULL);
return (0);
}
void
arcbios_fetch_system_identifier(struct arcbios_component *node,
struct arcbios_treewalk_context *atc)
{
switch (node->Class) {
case COMPONENT_CLASS_SystemClass:
arcbios_component_id_copy(node,
arcbios_system_identifier,
sizeof(arcbios_system_identifier));
atc->atc_terminate = 1;
break;
default:
break;
}
}
static void
arcbios_subtree_walk(struct arcbios_component *node,
void (*func)(struct arcbios_component *, struct arcbios_treewalk_context *),
struct arcbios_treewalk_context *atc)
{
for (node = arcbios_GetChild(node);
node != NULL && atc->atc_terminate == 0;
node = arcbios_GetPeer(node)) {
(*func)(node, atc);
if (atc->atc_terminate)
return;
arcbios_subtree_walk(node, func, atc);
}
}
void
arcbios_tree_walk(void (*func)(struct arcbios_component *,
struct arcbios_treewalk_context *), void *cookie)
{
struct arcbios_treewalk_context atc;
atc.atc_cookie = cookie;
atc.atc_terminate = 0;
arcbios_subtree_walk(NULL, func, &atc);
}
void
arcbios_component_id_copy(struct arcbios_component *node,
char *dst, size_t dstsize)
{
dstsize--;
if (dstsize > node->IdentifierLength)
dstsize = node->IdentifierLength;
memcpy(dst, (void *)(intptr_t)node->Identifier, dstsize);
dst[dstsize] = '\0';
}
int
arcbios_cngetc(dev_t dev)
{
u_long count;
char c;
arcbios_Read(ARCBIOS_STDIN, &c, 1, &count);
return (c);
}
void
arcbios_cnputc(dev_t dev, int c)
{
u_long count;
char ch = c;
arcbios_Write(ARCBIOS_STDOUT, &ch, 1, &count);
}