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
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
|
#include <stdlib.h>
#include <string.h>
#include <pcilib.h>
#include "uca.h"
#include "uca-cam.h"
#include "uca-grabber.h"
#define set_void(p, type, value) { *((type *) p) = value; }
#define GET_HANDLE(cam) ((pcilib_t *) cam->user)
static void uca_ipe_handle_error(const char *format, ...)
{
/* Do nothing, we just check errno. */
}
static uint32_t uca_ipe_set_property(struct uca_camera_t *cam, enum uca_property_ids property, void *data)
{
return UCA_NO_ERROR;
}
static uint32_t uca_ipe_get_property(struct uca_camera_t *cam, enum uca_property_ids property, void *data, size_t num)
{
pcilib_t *handle = GET_HANDLE(cam);
pcilib_register_value_t value = 0;
switch (property) {
case UCA_PROP_NAME:
strncpy((char *) data, "IPE PCIe based on CMOSIS CMV2000", bytes);
break;
case UCA_PROP_WIDTH:
set_void(data, uint32_t, 2048);
break;
case UCA_PROP_HEIGHT:
set_void(data, uint32_t, 1088);
break;
case UCA_PROP_EXPOSURE:
pcilib_read_register(handle, NULL, "exp_time", &value);
set_void(data, uint32_t, (uint32_t) value);
case UCA_PROP_TEMPERATURE_SENSOR:
pcilib_read_register(handle, NULL, "cmosis_temperature", &value);
set_void(data, uint32_t, (uint32_t) value);
break;
case UCA_PROP_PGA_GAIN:
pcilib_read_register(handle, NULL, "pga", &value);
set_void(data, uint32_t, (uint32_t) value);
break;
case UCA_PROP_PGA_GAIN_MIN:
set_void(data, uint32_t, 0);
break;
case UCA_PROP_PGA_GAIN_MAX:
set_void(data, uint32_t, 3);
break;
case UCA_PROP_ADC_GAIN:
pcilib_read_register(handle, NULL, "adc_gain", &value);
set_void(data, uint32_t, (uint32_t) value);
break;
case UCA_PROP_ADC_GAIN_MIN:
set_void(data, uint32_t, 32);
break;
case UCA_PROP_ADC_GAIN_MAX:
set_void(data, uint32_t, 55);
break;
default:
return UCA_ERR_PROP_INVALID;
}
return UCA_NO_ERROR;
}
static uint32_t uca_ipe_start_recording(struct uca_camera_t *cam)
{
return UCA_NO_ERROR;
}
static uint32_t uca_ipe_stop_recording(struct uca_camera_t *cam)
{
return UCA_NO_ERROR;
}
static uint32_t uca_ipe_grab(struct uca_camera_t *cam, char *buffer)
{
return UCA_NO_ERROR;
}
static uint32_t uca_ipe_destroy(struct uca_camera_t *cam)
{
pcilib_close(GET_HANDLE(cam));
return UCA_NO_ERROR;
}
uint32_t uca_ipe_init(struct uca_camera_t **cam, struct uca_grabber_t *grabber)
{
pcilib_model_t model = PCILIB_MODEL_DETECT;
pcilib_bar_t bar = PCILIB_BAR_DETECT;
pcilib_t *handle = pcilib_open("/dev/fpga0", model);
if (handle < 0)
return UCA_ERR_CAM_NOT_FOUND;
pcilib_set_error_handler(&uca_ipe_handle_error, &uca_ipe_handle_error);
model = pcilib_get_model(handle);
struct uca_camera_t *uca = (struct uca_camera_t *) malloc(sizeof(struct uca_camera_t));
/* Camera found, set function pointers... */
uca->destroy = &uca_ipe_destroy;
uca->set_property = &uca_ipe_set_property;
uca->get_property = &uca_ipe_get_property;
uca->start_recording = &uca_ipe_start_recording;
uca->stop_recording = &uca_ipe_stop_recording;
uca->grab = &uca_ipe_grab;
uca->state = UCA_CAM_CONFIGURABLE;
uca->user = handle;
*cam = uca;
return UCA_NO_ERROR;
}
|
