Subversion Repositories NaviCtrl

Rev

Rev 733 | Blame | Compare with Previous | Last modification | View Log | RSS feed

#include <stdio.h>
#include <string.h>
#include "91x_lib.h"
#include "CamCtrl.h"
#include "i2c.h"
#include "timer1.h"
#include "led.h"
#include "main.h"
#include "uart1.h"
#include "compass.h"
#include "spi_slave.h"
#include "triggerlog.h"

FromCamCtrl_t FromCamCtrl;
ToCamCtrl_t ToCamCtrl;
u16 CamCtrlTimeout = 25000;

void InitCamCtrl(void)
{
 ToCamCtrl.CamCommand = 0;
 ToCamCtrl.ZoomInput = 128; // Middle -> no zoom
}

void CamCtrl_UpdateData(u8* pRxBuffer, u8 RxBufferSize)
{       // if crc is ok and number of byte are matching
  memcpy((u8 *)&FromCamCtrl, pRxBuffer, sizeof(FromCamCtrl));
//if(FromCamCtrl.CamStatus & CAM_STATE_PIC_CAPTURED)


        if(FromCamCtrl.CamStatus & CAM_STATE_REC_ACTIVE)                CamCtrlCharacter = 'R';
        else if(FromCamCtrl.CamStatus & CAM_STATE_PHOTO_MODE)   CamCtrlCharacter = 'P';
        else if(FromCamCtrl.CamStatus & CAM_STATE_CAM_DISCONN)  CamCtrlCharacter = '?';
        else if(FromCamCtrl.CamStatus & CAM_STATE_OFF)                  CamCtrlCharacter = '!';
        else if(TrigLogging.CountExternal)                                              CamCtrlCharacter = TrigLogging.CountExternal % 10 + '0';
        else if(FromCamCtrl.PhotoCount)                                                 CamCtrlCharacter = FromCamCtrl.PhotoCount % 10 + '0';
        else if(FromCamCtrl.CamStatus & CAM_STATE_RDY)                  CamCtrlCharacter = 'c';
        else  CamCtrlCharacter = ' ';

// c = camera is ready
// R = Record active
// P = Cam in Photo mode (LANC Camcorders)
// ! = Camera is off but connected
// ? = disconnected
// 0-9 = Photo releases

  if(FromCamCtrl.CamStatus & CAM_STATE_I2C_OK) CamCtrlTimeout = 3000;
}

void CamCtrl_GetData(u8 timeout)
{
 static u8 timing = 250, p63 = 0;
 static u8 force1photo = 0, delay ;             // makes one photo when switching from Off to Photo

 if(timing)
   {
    timing--;
   }
   else
        // try to catch the I2C buffer within timeout ms
   if(I2CBus_LockBuffer(I2C0, timeout))
        {
                u8 RxBytes = sizeof(FromCamCtrl);
                // initiate transmission
                ToCamCtrl.ZoomInput = 128 + PPM_In[EE_Parameter.CamCtrlZoomChannel];
                if(EE_Parameter.CamCtrlModeChannel)
                 {
                        if(PPM_In[EE_Parameter.CamCtrlModeChannel] > 50)        // max
                           {
                        ToCamCtrl.CamCommand &= ~CAM_CMD_REC_OFF;
                            ToCamCtrl.CamCommand |= CAM_CMD_REC_ON;
                                force1photo = 0;
                           }
                        else
                        if(PPM_In[EE_Parameter.CamCtrlModeChannel] < -50)        // min
                           {
                        ToCamCtrl.CamCommand &= ~CAM_CMD_REC_ON;
                            ToCamCtrl.CamCommand |= CAM_CMD_REC_OFF;
                                force1photo = 1;
                                p63 = 0;
                                delay = 5;
                                }
                    else         // Middle
                          {
                           if(delay) delay--;
                                else
                           {
                        if(force1photo || ((UART_VersionInfo.HWMajor >= 30) && TRIGGER_PP_INTERN) || ((UART_VersionInfo.HWMajor < 30) && (FC.StatusFlags2 & FC_STATUS2_OUT1_ACTIVE))) // internal Portpin or Flag
                                 {
                                  if(!p63) ToCamCtrl.CamCommand |= CAM_CMD_SHUTTER; // combined with the FC trigger output
                                  p63 = 1;
                                  force1photo = 0;
                                 }
                                 else p63 = 0;
                           }
                          }
                }

        I2CBus_Transmission(I2C0, CAM_SLAVE_ADDRESS, &ToCamCtrl, sizeof(ToCamCtrl), &CamCtrl_UpdateData, RxBytes);

        if(!EE_Parameter.CamCtrlModeChannel) ToCamCtrl.CamCommand = 0; // delete REC_OFF
        ToCamCtrl.CamCommand = CAM_CMD_SWITCH_ON | (ToCamCtrl.CamCommand & (CAM_CMD_REC_ON | CAM_CMD_REC_OFF));
        timing = 66; // 66ms = 15Hz
   }
   else timing = 11; // try again in 11ms
}