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 ;

        int i = 0;

        char buff[640*480] ;

        int palette[256] ;

        int c;

        unsigned long value ;

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

        if (fd < 0) {

                printf("Error: Opening device /dev/spartan\n");

                return fd ;

        }

        while (i < 54) {

                c = getchar();

                if (c == EOF)

                        error("Early end-of-file.");

                if ((i == 0) && (c != 0x42))

                        error("Not BMP format.");

                if ((i == 1) && (c != 0x4d))

                        error("Not BMP format.");

                if ((i == 2) && (c != 0x38))

                        error("Not 8-bit BMP format.");

                if ((i == 10) && (c != 0x36))

                        error("Not limited to 64 colors (6 bits).");

                if ((i == 11) && (c != 0x01))

                        error("Not limited to 64 colors (6 bits).");

                if ((i == 18) && (c != 0x80))

                        error("Not 640 pixels horizontal resolution.");

                if ((i == 19) && (c != 0x02))

                        error("Not 640 pixels horizontal resolution.");

                if ((i == 22) && (c != 0xe0))

                        error("Not 480 pixels vertical resolution.");

                if ((i == 23) && (c != 0x01))

                        error("Not 480 pixels vertical resolution.");

                i++;

        }

        // activate resource 2

        value = 0x00000002 ;

        result = ioctl(fd, SPARTAN_IOC_CURRESSET, value) ;

        /* Set palette */

        lseek(fd, SPARTAN_CRT_PALETTE_BASE, 0);

        while (i < 310) {

                if (c == EOF)

                        error("Early end-of-file.");

                palette[(i - 54)/4] = ((getchar() >> 4) << 12) | ((getchar() >> 4) << 8) | ((getchar() >> 4) << 4);

printf("%.4x\n", palette[(i - 54)/4]);

        getchar();

                i+=4;

        }

        while (i < 307510) {

                buff[sizeof(buff) - (i - 310)] =  (char)getchar();

                i++;

        }

        if(write(fd, palette, 0x400) != 0x400) {

                printf("Error writing device /dev/spartan\n");

                return -1;

        }

        ioctl(fd, SPARTAN_IOC_SET_VIDEO_BUFF, buff) ;

        close(fd);

        return 0;

}