summaryrefslogtreecommitdiff
path: root/2003/i/buzz/src/camera/camera.cc
blob: e9a7f60dd2a8408468f0da88666ac19eee7302a5 (plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
// camera.cc
// buzz - Programme du robot Efrei Robotique I1-I2 2003
// Copyright (C) 2003 Nicolas Schodet
//
#include "camera.h"
#include "erreur/erreur.h"
#include "kernel/pbus.h"

#include <fcntl.h>
#include <unistd.h>
#include <iostream>	// Debug.
#include <iomanip>	//
#include <fstream>

#define CAM_FILE "/dev/robotcam"

// Constructeur.
Camera::Camera ()
{
    // Ouvre le p�riph�rique.
    m_fd = open (CAM_FILE, O_RDONLY);
    if (m_fd == -1)
	throw ErreurFatale ("Impossible d'ouvrir le p�riph�rique de la"
			    " camera.\n");
    // Param�tre la camera.
    sccb_io param;
    ifstream rc ("rc/camera");
    int addr, data;
    while (!rc.eof ())
      {
	rc >> hex >> addr >> hex >> data;
	if (rc.good ())
	  {
	    param.addr = addr; param.data = data;
	    cout << "camera sccbwrite 0x" << hex << addr << " 0x" << data <<
		endl;
	    ioctl (m_fd, CAM_SCCBWRITE, &param);
	  }
      }
    // Affiche les param�tres.
    cout << hex << "camera sccbdump";
    for (addr = 0; addr < 0x50; ++addr)
      {
	if (!(addr % 16)) cout << endl;
	param.addr = addr;
	ioctl (m_fd, CAM_SCCBREAD, &param);
	data = param.data;
	cout << setw (2) << setfill ('0') << data << ' ';

      }
    cout << endl << dec;
    // Param�tre la taille de frame.
    m_frameSize = m_w * m_h * 3;
    ioctl (m_fd, CAM_SETFRAMESIZE, &m_frameSize);
}

// Destructeur.
Camera::~Camera ()
{
    // Ferme le p�riph�rique de camera.
    close (m_fd);
}

// Lit une image.
void
Camera::read (unsigned char *image) const
{
    int r;
    // Lit les donn�es sur la camera.
    r = ::read (m_fd, image, m_frameSize);
    cout << "camera read " << r << endl;
}