Subversion Repositories pci

#include <sys/types.h>        

#include <sys/stat.h>        

#include <fcntl.h>  

#include <malloc.h>

#include <unistd.h>

#include <stdio.h>

#include <spartan_kint.h>

#include <sys/ioctl.h>

int main()

{

        int result ;

        int fd ;

        unsigned long *buf ;

        unsigned long value ;

        unsigned long base ;

        unsigned long base_size ;

        fd = open("/dev/spartan", O_RDWR) ;

        if (fd < 0)

                return fd ;

        buf = (void *)malloc(4) ;

        if (buf == NULL)

                return -1 ;

        // probe driver

        result = ioctl(fd, SPARTAN_IOC_CURRESGET) ;

        if (result > 0)

                printf("Driver reports enabled resource although it was not enabled through ioctl yet\n!") ;

        result = ioctl(fd, SPARTAN_IOC_NUMOFRES) ;

        if (result != 2)

                printf("SDRAM reference design implements 2 BARs, driver reported %d!\n", result) ;

        result = ioctl(fd, SPARTAN_IOC_CURBASE, &base) ;

        if (base)

                printf("Driver reports base address resource selected although it was not yet initialized!\n") ;

        result = ioctl(fd, SPARTAN_IOC_CURBASEMAP, &base) ;

        if (base)

                printf("Driver reports base address remaped although it was not yet initialized!\n") ;

        result = ioctl(fd, SPARTAN_IOC_CURBASESIZE, &base_size) ;

        if (base_size)

                printf("Driver reports base address range non-zero although it was not yet initialized!\n") ;

        // activate resource 1

        value = 0x00000001 ;

        result = ioctl(fd, SPARTAN_IOC_CURRESSET, value) ;

        if (result)

                 printf("Driver reported failure to intialize resource 1 !\n") ;

        // activate resource 2

        value = 0x00000002 ;

        result = ioctl(fd, SPARTAN_IOC_CURRESSET, value) ;

        if (result)

                 printf("Driver reported failure to intialize resource 2!\n") ;

        // check if ioctl returns any meaningful values!

        result = ioctl(fd, SPARTAN_IOC_CURRESGET) ;

        if (result != 2)

                printf("Resource 2 was enabled, driver reports resurce %d active!\n", result) ;

        result = ioctl(fd, SPARTAN_IOC_CURBASE, &base) ;

        if (!base)

                printf("Driver should report non-zero base address when resource is selected!\n") ;

        else

                printf("Driver reports SDRAM at address %X\n", base) ;

        result = ioctl(fd, SPARTAN_IOC_CURBASEMAP, &base) ;

        if (!base)

                printf("Driver reports zero page base address although resource 2 is supposed to be enabled!\n") ;

        else

                printf("Driver reports SDRAM at remaped address %X\n", base) ;

        result = ioctl(fd, SPARTAN_IOC_CURBASESIZE, &base_size) ;

        if (!base_size)

                printf("Driver reports zero base address range although resource is supposed to be enabled\n") ;

        else

                printf("Driver reports SDRAM size %li\n", base_size) ;

        value  = 0x00000001 ;

        *(buf) = value ;

        while ((result = write(fd, buf, 4)) > 0)

        {

                value = value + 1 ;

                *(buf) = value ;

        }

        printf("%li writes succesfull!\n", value-1) ;

        // go back to start of image

        value = lseek(fd, 0, 0) ;

        if (result != 0)

        {

                printf("Seek didn't reset offset to 0i\n") ;

                return -1 ;

        }

        value = 0x00000001 ;

        while ((result = read(fd, buf, 4)) > 0)

        {

                if (value != *buf)

                        printf("Expected value was %X, actually read value was %X\n", value, *buf) ;

                value = value + 1 ;

        }

        printf("%li reads done!\n", value-1) ;

        close(fd) ;

        return result ;

}