Subversion Repositories sudoku

#ifndef _DRIVER_H

#define _DRIVER_H

#include <stdint.h>

#include <fcntl.h>

#include <unistd.h>

#include <assert.h>

#include <stdio.h>

#include <sys/mman.h>

class Driver

{

 public:

  Driver(uintptr_t paddr)

  {

    this->paddr = paddr;

    uintptr_t pgsize = sysconf(_SC_PAGESIZE);

    uintptr_t regsize = regs * sizeof(uintptr_t);

    uintptr_t memsize = (regsize-1)/pgsize*pgsize+1;

    /*printf("opening interface at %p\n", (void*)paddr);*/

    int fd = open("/dev/mem", O_RDWR | O_SYNC);

    assert(fd != -1);

    int prot = PROT_READ | PROT_WRITE;

    int flags = MAP_SHARED;

    vaddr = (uintptr_t)mmap(0, memsize, prot, flags, fd, paddr & ~(pgsize-1));

    assert((void*)vaddr != MAP_FAILED);

    vaddr = vaddr + (paddr & (pgsize-1));

  }

  void reset()

  {

    *(volatile uintptr_t*)(vaddr + 0x100) = 0xA;

  }

  uintptr_t read(int port)

  {

    return *reg_addr(port);

  }

  void write(int port, uintptr_t value)

  {

    *reg_addr(port) = value;

  }

  int num_ports() {

    return regs;

  }

 private:

  uintptr_t vaddr;

  uintptr_t paddr;

  static const int regs = 8;

  volatile uintptr_t* reg_addr(int port)

  {

    return (volatile uintptr_t*)vaddr + (regs - port - 1);

  }

};

#endif