Logo Search packages:      
Sourcecode: libdc1394-22 version File versions  Download package

control.c

/*
 * 1394-Based Digital Camera Control Library
 *
 * Camera control code for Linux
 *  
 * Written by
 *   Chris Urmson <curmson@ri.cmu.edu>
 *   Damien Douxchamps <ddouxchamps@users.sf.net>
 *   Dan Dennedy <ddennedy@users.sf.net>
 *   David Moore <dcm@acm.org>
 *
 * This library is free software; you can redistribute it and/or
 * modify it under the terms of the GNU Lesser General Public
 * License as published by the Free Software Foundation; either
 * version 2.1 of the License, or (at your option) any later version.
 *
 * This library is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
 * Lesser General Public License for more details.
 *
 * You should have received a copy of the GNU Lesser General Public
 * License along with this library; if not, write to the Free Software
 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
 */

#include "config.h"

#include <stdlib.h>
#include <errno.h>
#include <unistd.h>
#include <string.h>
#include <sys/time.h>
#include <arpa/inet.h>

#include "dc1394/internal.h"
#include "linux.h"
#include "offsets.h"
#include "types.h"


platform_t *
platform_new (void)
{
    platform_t * p = calloc (1, sizeof (platform_t));
    return p;
}
void
platform_free (platform_t * p)
{
    free (p);
}

struct _platform_device_t {
    uint32_t config_rom[256];
    int num_quads;
    int port, node, generation;
};

static int
read_retry (struct raw1394_handle * handle, nodeid_t node, nodeaddr_t addr,
            size_t length, quadlet_t * buffer)
{
    int retry = DC1394_MAX_RETRIES;
    while (retry > 0) {
        if (raw1394_read (handle, node, addr, length, buffer) == 0)
            return 0;
        if (errno != EAGAIN)
            return -1;

        usleep (100);
        retry--;
    }
    return -1;
}

platform_device_list_t *
platform_get_device_list (platform_t * p)
{
    platform_device_list_t * list;
    uint32_t allocated_size = 64;
    raw1394handle_t handle;
    int num_ports, i;

    handle = raw1394_new_handle ();
    if (!handle)
        return NULL;

    num_ports = raw1394_get_port_info (handle, NULL, 0);
    raw1394_destroy_handle (handle);

    list = calloc (1, sizeof (platform_device_list_t));
    if (!list)
        return NULL;
    list->devices = malloc(allocated_size * sizeof(platform_device_t *));
    if (!list->devices) {
        free (list);
        return NULL;
    }

    for (i = 0; i < num_ports; i++) {
        int num_nodes, j;

        handle = raw1394_new_handle_on_port (i);
        if (!handle)
            continue;

        num_nodes = raw1394_get_nodecount (handle);
        for (j = 0; j < num_nodes; j++) {
            platform_device_t * device;
            uint32_t quad;
            int k;

            if (read_retry (handle, 0xFFC0 | j, CONFIG_ROM_BASE + 0x400, 4, &quad) < 0)
                continue;

            device = malloc (sizeof (platform_device_t));
            if (!device)
                continue;

            device->config_rom[0] = ntohl (quad);
            device->port = i;
            device->node = j;
            device->generation = raw1394_get_generation (handle);
            for (k = 1; k < 256; k++) {
                if (read_retry (handle, 0xFFC0 | j, CONFIG_ROM_BASE + 0x400 + 4*k, 4, &quad) < 0)
                    break;
                device->config_rom[k] = ntohl (quad);
            }
            device->num_quads = k;

            list->devices[list->num_devices] = device;
            list->num_devices++;

            if (list->num_devices >= allocated_size) {
                allocated_size += 64;
                list->devices = realloc (list->devices, allocated_size * sizeof (platform_device_t *));
                if (!list->devices)
                    return NULL;
            }
        }
        raw1394_destroy_handle (handle);
    }

    return list;
}

void
platform_free_device_list (platform_device_list_t * d)
{
    int i;
    for (i = 0; i < d->num_devices; i++)
        free (d->devices[i]);
    free (d->devices);
    free (d);
}

int
platform_device_get_config_rom (platform_device_t * device,
    uint32_t * quads, int * num_quads)
{
    if (*num_quads > device->num_quads)
        *num_quads = device->num_quads;

    memcpy (quads, device->config_rom, *num_quads * sizeof (uint32_t));
    return 0;
}

platform_camera_t *
platform_camera_new (platform_t * p, platform_device_t * device, uint32_t unit_directory_offset)
{
    platform_camera_t * camera;
    raw1394handle_t handle;

    handle = raw1394_new_handle_on_port (device->port);
    if (!handle)
        return NULL;

    if (device->generation != raw1394_get_generation (handle)) {
        dc1394_log_error("generation has changed since bus was scanned");
        raw1394_destroy_handle (handle);
        return NULL;
    }

    camera = calloc (1, sizeof (platform_camera_t));
    camera->handle = handle;
    camera->port = device->port;
    camera->node = device->node;
    camera->generation = device->generation;
    return camera;
}

void platform_camera_free (platform_camera_t * cam)
{
    if (cam->capture.dma_device_file != NULL) {
        free (cam->capture.dma_device_file);
        cam->capture.dma_device_file = NULL;
    }

    raw1394_destroy_handle (cam->handle);
    free (cam);
}

void
platform_camera_set_parent (platform_camera_t * cam,
        dc1394camera_t * parent)
{
    cam->camera = parent;
}

void
platform_camera_print_info (platform_camera_t * cam, FILE *fd)
{
    fprintf(fd,"------ Camera platform-specific information ------\n");
    fprintf(fd,"Handle                            :     %p\n", cam->handle);
    fprintf(fd,"Port                              :     %d\n", cam->port);
    fprintf(fd,"Node                              :     %d\n", cam->node);
}

dc1394error_t
platform_camera_read (platform_camera_t * cam, uint64_t offset, uint32_t * quads, int num_quads)
{
    int i, retval, retry = DC1394_MAX_RETRIES;

    /* retry a few times if necessary (addition by PDJ) */
    while(retry--)  {
#ifdef DC1394_DEBUG_LOWEST_LEVEL
        fprintf(stderr,"get %d regs at 0x%llx : ",
                num_quads, offset + CONFIG_ROM_BASE);
#endif
        retval = raw1394_read (cam->handle, 0xffc0 | cam->node, offset + CONFIG_ROM_BASE, 4 * num_quads, quads);
#ifdef DC1394_DEBUG_LOWEST_LEVEL
        fprintf(stderr,"0x%lx [...]\n", quads[0]);
#endif

        if (!retval)
            goto out;
        else if (errno != EAGAIN)
            return ( retval ? DC1394_RAW1394_FAILURE : DC1394_SUCCESS );

        // usleep is executed only if the read fails!!!
        usleep(DC1394_SLOW_DOWN);
    }

 out:
    /* conditionally byte swap the value */
    for (i = 0; i < num_quads; i++)
        quads[i] = ntohl (quads[i]);
    return ( retval ? DC1394_RAW1394_FAILURE : DC1394_SUCCESS );
}

dc1394error_t
platform_camera_write (platform_camera_t * cam, uint64_t offset, const uint32_t * quads, int num_quads)
{
    int i, retval, retry= DC1394_MAX_RETRIES;
    uint32_t value[num_quads];

    /* conditionally byte swap the value (addition by PDJ) */
    for (i = 0; i < num_quads; i++)
        value[i] = htonl (quads[i]);

    /* retry a few times if necessary */
    while(retry--) {
#ifdef DC1394_DEBUG_LOWEST_LEVEL
        fprintf(stderr,"set %d regs at 0x%llx to value 0x%lx [...]\n",
                num_quads, offset + CONFIG_ROM_BASE, value[0]);
#endif
        retval = raw1394_write(cam->handle, 0xffc0 | cam->node, offset + CONFIG_ROM_BASE, 4 * num_quads, value);

        if (!retval || (errno != EAGAIN))
            return ( retval ? DC1394_RAW1394_FAILURE : DC1394_SUCCESS );

        // usleep is executed only if the read fails!!!
        usleep(DC1394_SLOW_DOWN);
    }

    return DC1394_RAW1394_FAILURE;
}

dc1394error_t
platform_reset_bus (platform_camera_t * cam)
{
    if (raw1394_reset_bus (cam->handle) == 0)
        return DC1394_SUCCESS;
    else
        return DC1394_FAILURE;
}

dc1394error_t
platform_read_cycle_timer (platform_camera_t * cam, uint32_t * cycle_timer, uint64_t * local_time)
{
    quadlet_t quad;
    struct timeval tv;

    if (raw1394_read (cam->handle, raw1394_get_local_id (cam->handle),
                      CSR_REGISTER_BASE + CSR_CYCLE_TIME, sizeof (quadlet_t), &quad) < 0)
        return DC1394_FAILURE;

    gettimeofday (&tv, NULL);
    *cycle_timer = ntohl (quad);
    *local_time = (uint64_t)tv.tv_sec * 1000000ULL + tv.tv_usec;
    return DC1394_SUCCESS;
}

dc1394error_t
platform_set_broadcast(platform_camera_t * craw, dc1394bool_t pwr)
{
    if (pwr==DC1394_TRUE) {
        if (craw->broadcast_is_set==DC1394_FALSE) {
            craw->backup_node_id=craw->node;
            craw->node=63;
            craw->broadcast_is_set=DC1394_TRUE;
        }
    }
    else if (pwr==DC1394_FALSE) {
        if (craw->broadcast_is_set==DC1394_TRUE) {
            craw->node=craw->backup_node_id;
            craw->broadcast_is_set=DC1394_FALSE;
        }
    }
    else
        return DC1394_INVALID_ARGUMENT_VALUE;

    return DC1394_SUCCESS;
}

dc1394error_t
platform_get_broadcast(platform_camera_t * craw, dc1394bool_t *pwr)
{
    *pwr=craw->broadcast_is_set;

    return DC1394_SUCCESS;
}

dc1394error_t
platform_iso_set_persist (platform_camera_t * cam)
{
    return DC1394_SUCCESS;
}

dc1394error_t
platform_iso_allocate_channel (platform_camera_t * cam,  uint64_t channels_allowed, int * channel)
{
    int i;

    for (i = 0; i < 64; i++) {
        if (!((channels_allowed >> i) & 1))
            continue;
        if (raw1394_channel_modify (cam->handle, i, RAW1394_MODIFY_ALLOC) == 0)
            break;
    }

    if (i == 64) {
        dc1394_log_error ("Error: Failed to allocate iso channel");
        return DC1394_NO_ISO_CHANNEL;
    }

    *channel = i;
    return DC1394_SUCCESS;
}

dc1394error_t
platform_iso_release_channel (platform_camera_t * cam, int channel)
{
    if (raw1394_channel_modify (cam->handle, channel, RAW1394_MODIFY_FREE) < 0) {
        dc1394_log_error("Error: Could not free iso channel");
        return DC1394_FAILURE;
    }

    return DC1394_SUCCESS;
}

dc1394error_t
platform_iso_allocate_bandwidth (platform_camera_t * cam, int bandwidth_units)
{
    if (raw1394_bandwidth_modify (cam->handle, bandwidth_units, RAW1394_MODIFY_ALLOC) < 0) {
        dc1394_log_error ("Error: Failed to allocate iso bandwidth");
        return DC1394_NO_BANDWIDTH;
    }

    return DC1394_SUCCESS;
}

dc1394error_t
platform_iso_release_bandwidth (platform_camera_t * cam, int bandwidth_units)
{
    if (raw1394_bandwidth_modify (cam->handle, bandwidth_units, RAW1394_MODIFY_FREE) < 0) {
        dc1394_log_error ("Error: Failed to free iso bandwidth");
        return DC1394_FAILURE;
    }

    return DC1394_SUCCESS;
}

dc1394error_t
platform_camera_get_node(platform_camera_t *cam, uint32_t *node,
        uint32_t * generation)
{
    if (node)
        *node = cam->node;
    if (generation)
        *generation = cam->generation;
    return DC1394_SUCCESS;
}

dc1394error_t
dc1394_camera_get_linux_port(dc1394camera_t *camera, uint32_t *port)
{

    dc1394camera_priv_t * cpriv = DC1394_CAMERA_PRIV (camera);
    platform_camera_t * craw = cpriv->pcam;

    *port=craw->port;

    return DC1394_SUCCESS;
}

Generated by  Doxygen 1.6.0   Back to index