/* * 1394-Based Digital Camera register access functions * Written by Damien Douxchamps <ddouxchamps@users.sf.net> * * 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 "dc1394_control.h"#include "dc1394_internal.h"#include "dc1394_offsets.h"#include "dc1394_utils.h"#include "config.h"/* Note: debug modes can be very verbose. *//* To debug config rom structure: *///#define DC1394_DEBUG_TAGGED_REGISTER_ACCESS#define FEATURE_TO_ABS_VALUE_OFFSET(feature, offset)                  \    {                                                                 \    if ( (feature > DC1394_FEATURE_MAX) || (feature < DC1394_FEATURE_MIN) )  \    {                                                                 \	return DC1394_FAILURE;                                        \    }                                                                 \    else if (feature < DC1394_FEATURE_ZOOM)                           \    {                                                                 \	offset= REG_CAMERA_FEATURE_ABS_HI_BASE;                       \        feature-= DC1394_FEATURE_MIN;                                 \    }                                                                 \    else                                                              \    {                                                                 \	offset= REG_CAMERA_FEATURE_ABS_LO_BASE;                       \	feature-= DC1394_FEATURE_ZOOM;                                \                                                                      \	if (feature >= DC1394_FEATURE_CAPTURE_SIZE)                   \	{                                                             \	    feature+= 12;                                             \	}                                                             \                                                                      \    }                                                                 \                                                                      \    offset+= feature * 0x04U;                                         \    }/********************************************************************************//* Get/Set Command Registers                                                    *//********************************************************************************/dc1394error_tGetCameraControlRegister(dc1394camera_t *camera, octlet_t offset, quadlet_t *value){  int retval;  if (camera == NULL)    return DC1394_FAILURE;  /*  if (camera->command_registers_base == 0) {    fprintf(stderr,"this should not happen\n");    if (dc1394_get_camera_info(camera) != DC1394_SUCCESS)      return DC1394_FAILURE;  }  */  //fprintf(stderr,"trying to get 0x%llx",camera->command_registers_base+offset);  retval = GetCameraROMValue(camera, camera->command_registers_base+offset, value);  //fprintf(stderr,"retval = %d",retval);  return retval;}dc1394error_tSetCameraControlRegister(dc1394camera_t *camera, octlet_t offset, quadlet_t value){  int retval;  if (camera == NULL)    return DC1394_FAILURE;  /*  if (camera->command_registers_base == 0) {    if (dc1394_get_camera_info(camera) != DC1394_SUCCESS)      return DC1394_FAILURE;  }  */  //fprintf(stderr,"trying to set 0x%llx\n",camera->command_registers_base+offset);  retval= SetCameraROMValue(camera, camera->command_registers_base+offset, value);  return retval;}/********************************************************************************//* Get/Set Advanced Features Registers                                          *//********************************************************************************/dc1394error_tGetCameraAdvControlRegister(dc1394camera_t *camera, octlet_t offset, quadlet_t *value){  if (camera == NULL)    return DC1394_FAILURE;  /*  if (camera->advanced_features_csr == 0) {    if (dc1394_get_camera_info(camera) != DC1394_SUCCESS)      return DC1394_FAILURE;  }  */  return GetCameraROMValue(camera, camera->advanced_features_csr+offset, value);}dc1394error_tSetCameraAdvControlRegister(dc1394camera_t *camera, octlet_t offset, quadlet_t value){  if (camera == NULL)    return DC1394_FAILURE;  /*  if (camera->advanced_features_csr == 0) {    if (dc1394_get_camera_info(camera) != DC1394_SUCCESS)      return DC1394_FAILURE;  }  */  return SetCameraROMValue(camera, camera->advanced_features_csr+offset, value);}/********************************************************************************//* Get/Set Format_7 Registers                                                   *//********************************************************************************/dc1394error_tQueryFormat7CSROffset(dc1394camera_t *camera, dc1394video_mode_t mode, octlet_t *offset){  int retval;  quadlet_t temp;  if (camera == NULL) {    return DC1394_FAILURE;  }  if (!dc1394_is_video_mode_scalable(mode))    return DC1394_FAILURE;    retval=GetCameraControlRegister(camera, REG_CAMERA_V_CSR_INQ_BASE + ((mode - DC1394_VIDEO_MODE_FORMAT7_MIN) * 0x04U), &temp);  //fprintf(stderr,"got register 0x%llx : 0x%x, err=%d\n",  //	  CONFIG_ROM_BASE + REG_CAMERA_V_CSR_INQ_BASE + ((mode - MODE_FORMAT7_MIN) * 0x04U),temp,retval);  *offset=temp*4;  return retval;}dc1394error_tGetCameraFormat7Register(dc1394camera_t *camera, dc1394video_mode_t mode, octlet_t offset, quadlet_t *value){  if (camera == NULL) {    return DC1394_FAILURE;  }  if (!dc1394_is_video_mode_scalable(mode))    return DC1394_FAILURE;  if (camera->format7_csr[mode-DC1394_VIDEO_MODE_FORMAT7_MIN]==0) {    //fprintf(stderr,"getting offset for mode %d: ",mode);    if (QueryFormat7CSROffset(camera, mode, &camera->format7_csr[mode-DC1394_VIDEO_MODE_FORMAT7_MIN]) != DC1394_SUCCESS) {      //fprintf(stderr,"Error getting F7 CSR offset\n");      return DC1394_FAILURE;    }          //fprintf(stderr,"0x%llx\n",camera->format7_csr[mode-MODE_FORMAT7_MIN]);  }  return GetCameraROMValue(camera, camera->format7_csr[mode-DC1394_VIDEO_MODE_FORMAT7_MIN]+offset, value);  //fprintf(stderr,"got register 0x%llx : 0x%x, err=%d\n",CONFIG_ROM_BASE + camera->format7_csr[mode-MODE_FORMAT7_MIN]+offset, *value,retval);}dc1394error_tSetCameraFormat7Register(dc1394camera_t *camera, dc1394video_mode_t mode, octlet_t offset, quadlet_t value){  if (camera == NULL) {    return DC1394_FAILURE;  }  if (!dc1394_is_video_mode_scalable(mode))    return DC1394_FAILURE;  if (camera->format7_csr[mode-DC1394_VIDEO_MODE_FORMAT7_MIN]==0) {    QueryFormat7CSROffset(camera, mode, &camera->format7_csr[mode-DC1394_VIDEO_MODE_FORMAT7_MIN]);  }  //fprintf(stderr,"trying to set F7 0x%llx\n",camera->format7_csr[mode-MODE_FORMAT7_MIN]+offset);  return SetCameraROMValue(camera, camera->format7_csr[mode-DC1394_VIDEO_MODE_FORMAT7_MIN]+offset, value);}/********************************************************************************//* Get/Set Absolute Control Registers                                           *//********************************************************************************/dc1394error_tQueryAbsoluteCSROffset(dc1394camera_t *camera, dc1394feature_t feature){  int offset, retval;  quadlet_t quadlet=0;    if (camera == NULL) {    return DC1394_FAILURE;  }  if (camera->absolute_control_csr==0) {    FEATURE_TO_ABS_VALUE_OFFSET(feature, offset);        retval=GetCameraControlRegister(camera, offset, &quadlet);      camera->absolute_control_csr=quadlet * 0x04;    return retval;  }  else {    return DC1394_SUCCESS;  }}dc1394error_tGetCameraAbsoluteRegister(dc1394camera_t *camera, dc1394feature_t feature, octlet_t offset, quadlet_t *value){  if (camera == NULL) {    return DC1394_FAILURE;  }  QueryAbsoluteCSROffset(camera, feature);  return GetCameraROMValue(camera, camera->absolute_control_csr+offset, value);}dc1394error_tSetCameraAbsoluteRegister(dc1394camera_t *camera, dc1394feature_t feature, octlet_t offset, quadlet_t value){  if (camera == NULL) {    return DC1394_FAILURE;  }  QueryAbsoluteCSROffset(camera, feature);  return SetCameraROMValue(camera, camera->absolute_control_csr+offset, value);}/********************************************************************************//* Find a register with a specific tag                                          *//********************************************************************************/#ifdef DC1394_DEBUG_TAGGED_REGISTER_ACCESS// Don Murray's debug versionintGetConfigROMTaggedRegister(dc1394camera_t *camera, unsigned int tag, octlet_t *offset, quadlet_t *value){  unsigned int block_length;  int i;  // get the block length  fprintf(stderr,"Getting register tag 0x%x starting at offset 0x%llx\n",tag,*offset);  if (GetCameraROMValue(camera, *offset, value)!=DC1394_SUCCESS) {    fprintf(stderr,"Failed to get the block length\n" );    return DC1394_FAILURE;  }  block_length=*value>>16;  fprintf(stderr,"The block length is %d quadlets\n",block_length);  if (*offset+block_length*4>CSR_CONFIG_ROM_END) {    block_length=(CSR_CONFIG_ROM_END-*offset)/4;   }    // find the tag and return the result  for (i=0;i<block_length;i++) {    *offset+=4;    if (GetCameraROMValue(camera,*offset,value)!=DC1394_SUCCESS) {      fprintf(stderr,"GetCameraROMValue() failed\n" );      return DC1394_FAILURE;    }    if ((*value>>24)==tag) {      fprintf(stderr,"found tag 0x%x!!\n", tag );      return DC1394_SUCCESS;    }    else {      fprintf(stderr,"found tag 0x%x (value 0x%x) - continue \n",	      *value>>24,	      *value & 0xFFFFFF);    }  }    fprintf(stderr,"Tag not found :-(\n");  return DC1394_TAGGED_REGISTER_NOT_FOUND;}#elsedc1394error_tGetConfigROMTaggedRegister(dc1394camera_t *camera, unsigned int tag, octlet_t *offset, quadlet_t *value){  unsigned int block_length;  int i;    // get the block length  //fprintf(stderr,"Getting register tag 0x%x starting at offset 0x%x\n",tag,*offset);  if (GetCameraROMValue(camera, *offset, value)!=DC1394_SUCCESS) {    return DC1394_FAILURE;  }    block_length=*value>>16;  //fprintf(stderr,"  block length = %d\n",block_length);  if (*offset+block_length*4>CSR_CONFIG_ROM_END) {    block_length=(CSR_CONFIG_ROM_END-*offset)/4;  }  // find the tag and return the result  for (i=0;i<block_length;i++) {    *offset+=4;    if (GetCameraROMValue(camera,*offset,value)!=DC1394_SUCCESS) {      return DC1394_FAILURE;    }    if ((*value>>24)==tag) {      return DC1394_SUCCESS;    }  }  return DC1394_TAGGED_REGISTER_NOT_FOUND;}#endif