Subversion Repositories igor

#include <stdint.h>
#include <stdio.h>
#include <string.h>
#include "device.h"
 
igordev_read_fn_t skeleton_read;
igordev_write_fn_t skeleton_write;
igordev_init_fn_t skeleton_init;
igordev_status_fn_t skeleton_read_status;
igordev_status_fn_t skeleton_write_status;
igordev_deinit_fn_t skeleton_deinit;
 
/* Example device for adding device-specific hooks. */
 
const char *str= "(cons foo bar)";
 
struct igordev igordev_skeleton = {
	.init = skeleton_init,
	.deinit = skeleton_deinit,
	.read = skeleton_read,
	.write = skeleton_write,
	.read_status = skeleton_read_status,
	.write_status = skeleton_write_status,
	.maxaddr = 14,
	.curaddr = 0,
	.priv = NULL
};
 
int skeletondev_loaded = 0;
int status;
 
/* Example initialization routine. */
void
skeleton_init(void)
{
	/* Initialize buffers. Could probably be device-independent */
	status = 0;
	/* Initialize skelton device-specific stuff. */
	skeletondev_loaded = 1;
}
 
/* Example read routine. */
uint8_t
skeleton_read(uint8_t *data, uint8_t numbytes)
{
	uint64_t curaddr, maxaddr;
	uint8_t i;
 
	curaddr = igordev_skeleton.curaddr;
	maxaddr = igordev_skeleton.maxaddr;
	printf("Reading in curdev (curaddr, maxaddr) = (%llu, %llu)\n", curaddr,
	    maxaddr);
	if (curaddr < 0 || curaddr >= maxaddr) {
		status = IDEV_STATUS_ERROR;
		return (0);
	}
	printf("numbytes: %d\n", numbytes);
	for (i = 0; i < numbytes && (i + curaddr) < maxaddr; i++) {
		printf("READING %c\n", str[i + curaddr]);
		*(data + i) = str[i + curaddr];
	}
	status = IDEV_STATUS_OK;
	return (i);
}
 
/* Example write routine. */
uint8_t
skeleton_write(uint8_t *data, uint8_t numbytes)
{
	int i;
 
	/* Write buffer data to device. We're just testing. */
	for (i = 0; i < numbytes; i++) {
#ifdef WITH_DEBUG
		printf("SKELTON OUT: %c\n", *(data + i));
#endif
	}
	status = IDEV_STATUS_OK;
	return (0);
}
 
/* Deinit. */
void
skeleton_deinit(void)
{
	skeletondev_loaded = 0;
}
 
/* 
 * Example on checking read status.
 * XXX: IMPORTANT: Use correct status flags.
 */
int8_t
skeleton_read_status(void)
{
	return (status);
}
 
/*
 * Example on checking write status.
 * XXX: IMPORTANT: Use correct status flags.
 */
int8_t
skeleton_write_status(void)
{
	/* 
	 * We do not support write, but one would here check write status of the
	 * device.
	 */
	return (status);
}