add some more structured packet handling

[netwatch.git] / tools / poke-rls.c

#include <sys/io.h>
#include <reg-82801b.h>
#include <string.h>
#include <stdint.h>
#include <stdlib.h>

static uint16_t _get_PMBASE()
{
	static long pmbase = -1;

	if (pmbase == -1) 
		pmbase = pci_read32(ICH2_LPC_BUS, ICH2_LPC_DEV, ICH2_LPC_FN, ICH2_LPC_PCI_PMBASE) & ICH2_PMBASE_MASK;

	return pmbase;
}

typedef struct {
	uint32_t signature;
	uint32_t type;
	uint8_t data[];
} packet_t;

extern unsigned int poke(unsigned long addr, unsigned long * value);

int main(int argc, char **argv)
{
	unsigned int res;
	packet_t * packet = (packet_t *)memalign(4096, sizeof(packet_t));

	packet->signature = 0x1BADD00D;
	packet->type = 0xF00FC7C8;

	if (iopl(3) < 0)
	{
		perror("iopl");
		return 1;
	}
	
	res = poke(_get_PMBASE() + 0x04, (void *)packet);
	printf("returned %p\n", res);
}