diff options
Diffstat (limited to 'src/cameras/pco.c')
| -rw-r--r-- | src/cameras/pco.c | 245 |
1 files changed, 245 insertions, 0 deletions
diff --git a/src/cameras/pco.c b/src/cameras/pco.c new file mode 100644 index 0000000..88f1e23 --- /dev/null +++ b/src/cameras/pco.c @@ -0,0 +1,245 @@ + +#include <stdlib.h> +#include <string.h> +#include <clser.h> +#include <fgrab_struct.h> +#include <fgrab_prototyp.h> +#include <libpco/libpco.h> +#include "uca.h" +#include "uca-cam.h" +#include "pco.h" + +struct pco_cam_t { + struct pco_edge_t *pco; + Fg_Struct *fg; +}; + +#define GET_PCO(uca) (((struct pco_cam_t *)(uca->user))->pco) +#define GET_FG(uca) (((struct pco_cam_t *)(uca->user))->fg) + +#define set_void(p, type, value) { *((type *) p) = value; } + + +static uint32_t uca_pco_set_bitdepth(struct uca_camera_t *cam, uint8_t *bitdepth) +{ + /* TODO: it's not possible via CameraLink so do it via frame grabber */ + return 0; +} + +static uint32_t uca_pco_set_exposure(struct uca_camera_t *cam, uint32_t *exposure) +{ + uint32_t e, d; + if (pco_get_delay_exposure(GET_PCO(cam), &d, &e) != PCO_NOERROR) + return UCA_ERR_PROP_GENERAL; + if (pco_set_delay_exposure(GET_PCO(cam), d, *exposure) != PCO_NOERROR) + return UCA_ERR_PROP_GENERAL; + return UCA_NO_ERROR; +} + +static uint32_t uca_pco_set_delay(struct uca_camera_t *cam, uint32_t *delay) +{ + uint32_t e, d; + if (pco_get_delay_exposure(GET_PCO(cam), &d, &e) != PCO_NOERROR) + return UCA_ERR_PROP_GENERAL; + if (pco_set_delay_exposure(GET_PCO(cam), *delay, e) != PCO_NOERROR) + return UCA_ERR_PROP_GENERAL; + return UCA_NO_ERROR; +} + +static uint32_t uca_pco_acquire_image(struct uca_camera_t *cam, void *buffer) +{ + return UCA_NO_ERROR; +} + +static uint32_t uca_pco_destroy(struct uca_camera_t *cam) +{ + Fg_FreeGrabber(GET_FG(cam)); + pco_destroy(GET_PCO(cam)); + free(cam->user); + return UCA_NO_ERROR; +} + +static uint32_t uca_pco_set_property(struct uca_camera_t *cam, enum uca_property_ids property, void *data) +{ + switch (property) { + case UCA_PROP_WIDTH: + if (Fg_setParameter(GET_FG(cam), FG_WIDTH, (uint32_t *) data, PORT_A) != FG_OK) + return UCA_ERR_PROP_VALUE_OUT_OF_RANGE; + break; + + case UCA_PROP_HEIGHT: + if (Fg_setParameter(GET_FG(cam), FG_HEIGHT, (uint32_t *) data, PORT_A) != FG_OK) + return UCA_ERR_PROP_VALUE_OUT_OF_RANGE; + break; + + case UCA_PROP_X_OFFSET: + if (Fg_setParameter(GET_FG(cam), FG_XOFFSET, (uint32_t *) data, PORT_A) != FG_OK) + return UCA_ERR_PROP_VALUE_OUT_OF_RANGE; + break; + + case UCA_PROP_Y_OFFSET: + if (Fg_setParameter(GET_FG(cam), FG_YOFFSET, (uint32_t *) data, PORT_A) != FG_OK) + return UCA_ERR_PROP_VALUE_OUT_OF_RANGE; + break; + + case UCA_PROP_EXPOSURE: + return uca_pco_set_exposure(cam, (uint32_t *) data); + + case UCA_PROP_DELAY: + return uca_pco_set_delay(cam, (uint32_t *) data); + + default: + return UCA_ERR_PROP_INVALID; + } + return UCA_NO_ERROR; +} + + +static uint32_t uca_pco_get_property(struct uca_camera_t *cam, enum uca_property_ids property, void *data) +{ + struct pco_edge_t *pco = GET_PCO(cam); + + switch (property) { + case UCA_PROP_NAME: + { + /* FIXME: how to ensure, that buffer is large enough? */ + SC2_Camera_Name_Response name; + if (pco_read_property(pco, GET_CAMERA_NAME, &name, sizeof(name)) == PCO_NOERROR) + strcpy((char *) data, name.szName); + } + break; + + case UCA_PROP_WIDTH: + { + int w, h; + if (pco_get_actual_size(pco, &w, &h) == PCO_NOERROR) + set_void(data, uint32_t, w); + } + break; + + case UCA_PROP_WIDTH_MIN: + set_void(data, uint32_t, 1); + break; + + case UCA_PROP_WIDTH_MAX: + set_void(data, uint32_t, pco->description.wMaxHorzResStdDESC); + break; + + case UCA_PROP_HEIGHT: + { + int w, h; + if (pco_get_actual_size(pco, &w, &h) == PCO_NOERROR) + set_void(data, uint32_t, h); + } + break; + + case UCA_PROP_HEIGHT_MIN: + set_void(data, uint32_t, 1); + break; + + case UCA_PROP_HEIGHT_MAX: + set_void(data, uint32_t, pco->description.wMaxVertResStdDESC); + break; + + case UCA_PROP_X_OFFSET: + if (Fg_getParameter(GET_FG(cam), FG_XOFFSET, (uint32_t *) data, PORT_A) != FG_OK) + return UCA_ERR_PROP_GENERAL; + break; + + case UCA_PROP_Y_OFFSET: + if (Fg_getParameter(GET_FG(cam), FG_YOFFSET, (uint32_t *) data, PORT_A) != FG_OK) + return UCA_ERR_PROP_GENERAL; + break; + + case UCA_PROP_DELAY_MIN: + set_void(data, uint32_t, pco->description.dwMinDelayDESC); + break; + + case UCA_PROP_DELAY_MAX: + set_void(data, uint32_t, pco->description.dwMaxDelayDESC); + break; + + case UCA_PROP_EXPOSURE_MIN: + set_void(data, uint32_t, pco->description.dwMinExposureDESC); + break; + + case UCA_PROP_EXPOSURE_MAX: + set_void(data, uint32_t, pco->description.dwMaxExposureDESC); + break; + + case UCA_PROP_BITDEPTH: + set_void(data, uint8_t, 16); + break; + + default: + return UCA_ERR_PROP_INVALID; + } + return UCA_NO_ERROR; +} + +uint32_t uca_pco_alloc(struct uca_camera_t *cam, uint32_t n_buffers) +{ + +} + +uint32_t uca_pco_init(struct uca_camera_t **cam) +{ + struct pco_cam_t *pco_cam = (struct pco_cam_t *) malloc(sizeof(struct pco_cam_t)); + struct pco_edge_t *pco = pco_cam->pco = pco_init(); + + if (pco == NULL) { + free(pco_cam); + return UCA_ERR_INIT_NOT_FOUND; + } + + if ((pco->serial_ref == NULL) || !pco_active(pco)) { + free(pco_cam); + pco_destroy(pco); + return UCA_ERR_INIT_NOT_FOUND; + } + + Fg_Struct *fg = pco_cam->fg = Fg_Init("libFullAreaGray8.so", 0); + + struct uca_camera_t *uca = (struct uca_camera_t *) malloc(sizeof(struct uca_camera_t)); + uca->user = pco_cam; + + /* Camera found, set function pointers... */ + uca->destroy = &uca_pco_destroy; + uca->set_property = &uca_pco_set_property; + uca->get_property = &uca_pco_get_property; + uca->alloc = &uca_pco_alloc; + uca->acquire_image = &uca_pco_acquire_image; + + /* Prepare camera for recording */ + pco_set_rec_state(pco, 0); + pco_set_timestamp_mode(pco, 2); + pco_set_timebase(pco, 1, 1); + pco_arm_camera(pco); + + if (pco->transfer.DataFormat != (SCCMOS_FORMAT_TOP_CENTER_BOTTOM_CENTER | PCO_CL_DATAFORMAT_5x16)) + pco->transfer.DataFormat = SCCMOS_FORMAT_TOP_CENTER_BOTTOM_CENTER | PCO_CL_DATAFORMAT_5x16; + + /* Prepare frame grabber for recording */ + int val = FG_CL_8BIT_FULL_10; + Fg_setParameter(fg, FG_CAMERA_LINK_CAMTYP, &val, PORT_A); + + val = FG_GRAY; + Fg_setParameter(fg, FG_FORMAT, &val, PORT_A); + + val = FREE_RUN; + Fg_setParameter(fg, FG_TRIGGERMODE, &val, PORT_A); + + int width, height; + pco_get_actual_size(pco, &width, &height); + + /* Yes, we really have to take an image twice as large because we set the + * CameraLink interface to 8-bit 10 Taps, but are actually using 5x16 bits. */ + width *= 2; + Fg_setParameter(fg, FG_WIDTH, &width, PORT_A); + Fg_setParameter(fg, FG_HEIGHT, &height, PORT_A); + + uca->state = UCA_CAM_CONFIGURABLE; + *cam = uca; + + return UCA_NO_ERROR; +} |