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
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
|
/**********************************************************************
** Copyright (C) 2002 Michael 'Mickey' Lauer. All rights reserved.
**
** This file is part of Opie Environment.
**
** This file may be distributed and/or modified under the terms of the
** GNU General Public License version 2 as published by the Free Software
** Foundation and appearing in the file LICENSE.GPL included in the
** packaging of this file.
**
** This file is provided AS IS with NO WARRANTY OF ANY KIND, INCLUDING THE
** WARRANTY OF DESIGN, MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE.
**
**********************************************************************/
#include "zcameraio.h"
#include <sys/types.h>
#include <sys/stat.h>
#include <errno.h>
#include <string.h>
#include <fcntl.h>
#include <unistd.h>
#include <qimage.h>
#include <opie2/odebug.h>
ZCameraIO* ZCameraIO::_instance = 0;
ZCameraIO::ZCameraIO()
{
_driver = open( "/dev/sharp_zdc", O_RDWR );
if ( _driver == -1 )
oerr << "Can't open camera driver: " << strerror(errno) << oendl;
ZCameraIO::_instance = this;
};
ZCameraIO::~ZCameraIO()
{
if ( _driver != -1 )
close( _driver );
}
bool ZCameraIO::snapshot( QImage* image )
{
/*
char buf[76800];
write( _driver, "M=13", 4 );
write( _driver, "R=240,160,256,480", 17 );
write( _driver, "M=12", 4 );
int result = read( _driver, &buf, sizeof buf );
return result == sizeof buf;
*/
uchar buf[76800];
uchar* bp = buf;
uchar* p;
int fd = open( "/tmp/cam", O_RDONLY );
if ( read( fd, buf, sizeof buf ) != sizeof buf )
qDebug( "WARNING: couldn't read image!" );
image->create( 240, 160, 16 );
for ( int i = 0; i < 160; ++i )
{
p = image->scanLine( i );
for ( int j = 0; j < 240; j++ )
{
*p = *bp;
p++;
bp++;
*p = *bp;
p++;
bp++;
}
}
return true;
}
|
