#include <stdio.h>
#include <unistd.h>

#include "../FinePixUSBKit/FinePix.h"

int main ()
{
        FinePix* test = new FinePix();
        uint8 *frame = new uint8[100000]; // Max frame size 100k
        int total_size = 0;
        
        while(1) 
        {       // Wait around and let the (usb)roster do its thing
                snooze(1000000); 
                if (test->InitCheck() == B_OK) 
                {
                        fprintf(stderr, "Camera ready\n");
                        test->SetupCam();
                        for (int i=0; i<1; i++) { // Number of frames to get    
                                // Get a frame
                                test->GetPic(frame, total_size);
                                // Save the frame
                                //fprintf(stderr,"This frame was %d bytes\n", total_size);
                                char fname[100];
                                sprintf(fname, "frame-%05d.jpg", i);
                                int fd = open(fname, O_WRONLY | O_CREAT,0644);
                                write(fd, frame, total_size);
                                close(fd);
                                fprintf(stderr,"Saved as file:%s \n", fname);
                                
                                /* Wait before requesting next frame, 
                                 * for 30 fps wait less than 33333ms (1 sek / 30) */
                                snooze(30000);
                        }       
                        break;
                } else {
                        fprintf(stderr, "Camera not ready\n");
                }
        }
        
        delete test;
        return 0;
}