Staging: poch: Add sample Rx code
Add sample code Rx to README. Signed-off-by: Vijay Kumar B <vijaykumar@bravegnu.org> Signed-off-by: Greg Kroah-Hartman <gregkh@suse.de>
This commit is contained in:
parent
949d6ae745
commit
763a998fb2
|
@ -9,5 +9,128 @@ TODO:
|
||||||
- audit userspace interfaces
|
- audit userspace interfaces
|
||||||
- get reserved major/minor if needed
|
- get reserved major/minor if needed
|
||||||
|
|
||||||
|
Sample Code:
|
||||||
|
|
||||||
|
#include <sys/types.h>
|
||||||
|
#include <sys/stat.h>
|
||||||
|
#include <sys/mman.h>
|
||||||
|
#include <sys/ioctl.h>
|
||||||
|
#include <poll.h>
|
||||||
|
#include <stdio.h>
|
||||||
|
#include <error.h>
|
||||||
|
#include <errno.h>
|
||||||
|
#include <fcntl.h>
|
||||||
|
#include <stdint.h>
|
||||||
|
|
||||||
|
#include <sysfs/libsysfs.h>
|
||||||
|
|
||||||
|
#include <poch.h>
|
||||||
|
|
||||||
|
struct pconsume {
|
||||||
|
uint32_t * offsets;
|
||||||
|
uint32_t nfetch;
|
||||||
|
uint32_t nflush;
|
||||||
|
};
|
||||||
|
|
||||||
|
uint32_t offsets[10];
|
||||||
|
|
||||||
|
void process_group(unsigned char *buf, uint32_t size)
|
||||||
|
{
|
||||||
|
uint16_t *buf16 = (uint16_t *)buf;
|
||||||
|
|
||||||
|
printf("RX: %p %u %04x %04x %04x %04x %04x %04x\n", buf, size,
|
||||||
|
buf16[0], buf16[1], buf16[2], buf16[3], buf16[4], buf16[5]);
|
||||||
|
}
|
||||||
|
|
||||||
|
int main()
|
||||||
|
{
|
||||||
|
struct sysfs_attribute *attr;
|
||||||
|
char *path;
|
||||||
|
int ret;
|
||||||
|
unsigned long mmap_size;
|
||||||
|
int fd;
|
||||||
|
unsigned char *cbuf;
|
||||||
|
|
||||||
|
uint32_t nflush;
|
||||||
|
struct pollfd poll_fds;
|
||||||
|
int count = 0;
|
||||||
|
int i;
|
||||||
|
|
||||||
|
path = "/sys/class/pocketchange/poch0/ch0/block_size";
|
||||||
|
attr = sysfs_open_attribute(path);
|
||||||
|
ret = sysfs_write_attribute(attr, "256", strlen("256"));
|
||||||
|
if (ret == -1)
|
||||||
|
error(1, errno, "error writing attribute %s", path);
|
||||||
|
sysfs_close_attribute(attr);
|
||||||
|
|
||||||
|
path = "/sys/class/pocketchange/poch0/ch0/group_size";
|
||||||
|
attr = sysfs_open_attribute(path);
|
||||||
|
ret = sysfs_write_attribute(attr, "4096", strlen("4096"));
|
||||||
|
if (ret == -1)
|
||||||
|
error(1, errno, "error writing attribute %s", path);
|
||||||
|
sysfs_close_attribute(attr);
|
||||||
|
|
||||||
|
path = "/sys/class/pocketchange/poch0/ch0/group_count";
|
||||||
|
attr = sysfs_open_attribute(path);
|
||||||
|
ret = sysfs_write_attribute(attr, "64", strlen("64"));
|
||||||
|
if (ret == -1)
|
||||||
|
error(1, errno, "error writing attribute %s", path);
|
||||||
|
sysfs_close_attribute(attr);
|
||||||
|
|
||||||
|
fd = open("/dev/ch0", O_RDWR);
|
||||||
|
if (fd == -1)
|
||||||
|
error(1, errno, "error opening device node");
|
||||||
|
|
||||||
|
path = "/sys/class/pocketchange/poch0/ch0/mmap_size";
|
||||||
|
attr = sysfs_open_attribute(path);
|
||||||
|
ret = sysfs_read_attribute(attr);
|
||||||
|
if (ret == -1)
|
||||||
|
error(1, errno, "error reading attribute %s", path);
|
||||||
|
printf("%s", attr->value);
|
||||||
|
sscanf(attr->value, "%lu", &mmap_size);
|
||||||
|
sysfs_close_attribute(attr);
|
||||||
|
|
||||||
|
cbuf = mmap(NULL, mmap_size, PROT_READ | PROT_WRITE,
|
||||||
|
MAP_PRIVATE, fd, 0);
|
||||||
|
if (cbuf == MAP_FAILED)
|
||||||
|
error(1, errno, "error mapping DMA buffers");
|
||||||
|
|
||||||
|
ret = ioctl(fd, POCH_IOC_TRANSFER_START, 0);
|
||||||
|
if (ret == -1)
|
||||||
|
error(1, errno, "error starting transfer");
|
||||||
|
|
||||||
|
nflush = 0;
|
||||||
|
while (1) {
|
||||||
|
struct pconsume consume;
|
||||||
|
|
||||||
|
consume.offsets = offsets;
|
||||||
|
consume.nfetch = 10;
|
||||||
|
consume.nflush = nflush;
|
||||||
|
|
||||||
|
ret = ioctl(fd, POCH_IOC_CONSUME, &consume);
|
||||||
|
if (ret == -1)
|
||||||
|
error(1, errno, "error consuming groups");
|
||||||
|
|
||||||
|
nflush = consume.nfetch;
|
||||||
|
|
||||||
|
for (i = 0; i < nflush; i++) {
|
||||||
|
process_group(cbuf + consume.offsets[i], 4096);
|
||||||
|
|
||||||
|
count++;
|
||||||
|
if (count == 1000)
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (count == 1000)
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
|
||||||
|
ret = ioctl(fd, POCH_IOC_TRANSFER_STOP, 0);
|
||||||
|
if (ret == -1)
|
||||||
|
error(1, errno, "error starting transfer");
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
Please send patches to Greg Kroah-Hartman <greg@kroah.com> and
|
Please send patches to Greg Kroah-Hartman <greg@kroah.com> and
|
||||||
Vijay Kumar <vijaykumar@bravegnu.org> and Jaya Kumar <jayakumar.lkml@gmail.com>
|
Vijay Kumar <vijaykumar@bravegnu.org> and Jaya Kumar <jayakumar.lkml@gmail.com>
|
||||||
|
|
Loading…
Reference in New Issue