Add dummy camera with frame counter

1 files changed, 201 insertions, 0 deletions

diff --git a/src/cameras/dummy.c b/src/cameras/dummy.c
new file mode 100644
index 0000000..93952a9
--- /dev/null
+++ b/src/cameras/dummy.c
@@ -0,0 +1,201 @@
+
+#include <stdlib.h>
+#include <string.h>
+#include "uca.h"
+#include "uca-cam.h"
+#include "uca-grabber.h"
+
+struct dummy_cam_t {
+    uint32_t width;
+    uint32_t height;
+    uint32_t bitdepth;
+    uint32_t framerate;
+    uint32_t current_frame;
+    char*   buffer;
+};
+
+#define GET_DUMMY(uca) ((struct dummy_cam_t *)(uca->user))
+#define set_void(p, type, value) { *((type *) p) = value; }
+
+static uint32_t uca_dummy_set_property(struct uca_camera_t *cam, enum uca_property_ids property, void *data)
+{
+    return UCA_NO_ERROR;
+}
+
+static uint32_t uca_dummy_get_property(struct uca_camera_t *cam, enum uca_property_ids property, void *data)
+{
+    struct dummy_cam_t *dummy_cam = (struct dummy_cam_t *) cam->user;
+
+    switch (property) {
+        case UCA_PROP_NAME:
+            strcpy((char *) data, "dummy");
+            break;
+
+        case UCA_PROP_WIDTH:
+            set_void(data, uint32_t, dummy_cam->width);
+            break;
+
+        case UCA_PROP_WIDTH_MIN:
+            set_void(data, uint32_t, 1);
+            break;
+
+        case UCA_PROP_WIDTH_MAX:
+            set_void(data, uint32_t, 4096);
+            break;
+
+        case UCA_PROP_HEIGHT:
+            set_void(data, uint32_t, dummy_cam->height);
+            break;
+
+        case UCA_PROP_HEIGHT_MIN:
+            set_void(data, uint32_t, 1);
+            break;
+
+        case UCA_PROP_HEIGHT_MAX:
+            set_void(data, uint32_t, 4096);
+            break;
+
+        case UCA_PROP_BITDEPTH:
+            set_void(data, uint32_t, 8);
+            break;
+
+        default:
+            return UCA_ERR_PROP_INVALID;
+    }
+    return UCA_NO_ERROR;
+}
+
+uint32_t uca_dummy_start_recording(struct uca_camera_t *cam)
+{
+    GET_DUMMY(cam)->current_frame = 0;
+    return UCA_NO_ERROR;
+}
+
+uint32_t uca_dummy_stop_recording(struct uca_camera_t *cam)
+{
+    return UCA_NO_ERROR;
+}
+
+static const char digits[10][20] = {
+    /* 0 */
+    { 0x00, 0xff, 0xff, 0x00,
+      0xff, 0x00, 0x00, 0xff,
+      0xff, 0x00, 0x00, 0xff,
+      0xff, 0x00, 0x00, 0xff,
+      0x00, 0xff, 0xff, 0x00 },
+    /* 1 */
+    { 0x00, 0x00, 0xff, 0x00,
+      0x00, 0xff, 0xff, 0x00,
+      0x00, 0x00, 0xff, 0x00,
+      0x00, 0x00, 0xff, 0x00,
+      0x00, 0x00, 0xff, 0x00 },
+    /* 2 */
+    { 0x00, 0xff, 0xff, 0x00,
+      0xff, 0x00, 0x00, 0xff,
+      0x00, 0x00, 0xff, 0x00,
+      0x00, 0xff, 0x00, 0x00,
+      0xff, 0xff, 0xff, 0xff },
+    /* 3 */
+    { 0x00, 0xff, 0xff, 0x00,
+      0xff, 0x00, 0x00, 0xff,
+      0x00, 0x00, 0xff, 0x00,
+      0xff, 0x00, 0x00, 0xff,
+      0x00, 0xff, 0xff, 0x00 },
+    /* 4 */
+    { 0xff, 0x00, 0x00, 0x00,
+      0xff, 0x00, 0x00, 0xff,
+      0xff, 0xff, 0xff, 0xff,
+      0x00, 0x00, 0x00, 0xff,
+      0x00, 0x00, 0x00, 0xff },
+    /* 5 */
+    { 0xff, 0xff, 0xff, 0xff,
+      0xff, 0x00, 0x00, 0x00,
+      0x00, 0xff, 0xff, 0x00,
+      0x00, 0x00, 0x00, 0xff,
+      0xff, 0xff, 0xff, 0x00 },
+    /* 6 */
+    { 0x00, 0xff, 0xff, 0xff,
+      0xff, 0x00, 0x00, 0x00,
+      0xff, 0xff, 0xff, 0x00,
+      0xff, 0x00, 0x00, 0xff,
+      0x00, 0xff, 0xff, 0x00 },
+    /* 7 */
+    { 0xff, 0xff, 0xff, 0xff,
+      0x00, 0x00, 0x00, 0xff,
+      0x00, 0x00, 0xff, 0x00,
+      0x00, 0xff, 0x00, 0x00,
+      0xff, 0x00, 0x00, 0x00 },
+    /* 8 */
+    { 0x00, 0xff, 0xff, 0x00,
+      0xff, 0x00, 0x00, 0xff,
+      0x00, 0xff, 0xff, 0x00,
+      0xff, 0x00, 0x00, 0xff,
+      0x00, 0xff, 0xff, 0x00 },
+    /* 9 */
+    { 0x00, 0xff, 0xff, 0x00,
+      0xff, 0x00, 0x00, 0xff,
+      0x00, 0xff, 0xff, 0xff,
+      0x00, 0x00, 0x00, 0xff,
+      0xff, 0xff, 0xff, 0x00 }
+};
+
+static void uca_dummy_print_number(struct dummy_cam_t *dummy, int number, int x, int y)
+{
+    const int digit_width = 4;
+    const int digit_height = 5;
+    char *buffer = dummy->buffer;
+    for (int i = 0; i < digit_width; i++) {
+        for (int j = 0; j < digit_height; j++) {
+            buffer[(y+j)*dummy->width + (x+i)] = digits[number][j*digit_width+i];
+        }
+    }
+}
+
+uint32_t uca_dummy_grab(struct uca_camera_t *cam, char *buffer)
+{
+    struct dummy_cam_t *dummy = GET_DUMMY(cam);
+    dummy->buffer = buffer;
+
+    /* print current frame number */
+    unsigned int number = dummy->current_frame;
+    unsigned int divisor = 100000000;
+    int x = 10;
+    while (divisor > 1) {
+        uca_dummy_print_number(dummy, number / divisor, x, 10);
+        number = number % divisor;
+        divisor = divisor / 10;
+        x += 5;
+    }
+    dummy->current_frame++;
+    return UCA_NO_ERROR;
+}
+
+static uint32_t uca_dummy_destroy(struct uca_camera_t *cam)
+{
+    return UCA_NO_ERROR;
+}
+
+uint32_t uca_dummy_init(struct uca_camera_t **cam, struct uca_grabber_t *grabber)
+{
+    struct uca_camera_t *uca = (struct uca_camera_t *) malloc(sizeof(struct uca_camera_t));
+
+    uca->destroy = &uca_dummy_destroy;
+    uca->set_property = &uca_dummy_set_property;
+    uca->get_property = &uca_dummy_get_property;
+    uca->start_recording = &uca_dummy_start_recording;
+    uca->stop_recording = &uca_dummy_stop_recording;
+    uca->grab = &uca_dummy_grab;
+    uca->state = UCA_CAM_CONFIGURABLE;
+
+    struct dummy_cam_t *dummy_cam = (struct dummy_cam_t *) malloc(sizeof(struct dummy_cam_t));
+    dummy_cam->width = 320;
+    dummy_cam->height = 240;
+    dummy_cam->bitdepth = 8;
+    dummy_cam->framerate = 100;
+    dummy_cam->buffer = NULL;
+    uca->user = dummy_cam;
+
+    *cam = uca;
+
+    return UCA_NO_ERROR;
+}