Rev 730 | Rev 733 | Go to most recent revision | Details | Compare with Previous | Last modification | View Log | RSS feed
| Rev | Author | Line No. | Line |
|---|---|---|---|
| 728 | holgerb | 1 | #include <stdio.h> |
| 2 | #include <string.h> |
||
| 3 | #include "91x_lib.h" |
||
| 4 | #include "CamCtrl.h" |
||
| 5 | #include "i2c.h" |
||
| 6 | #include "timer1.h" |
||
| 7 | #include "led.h" |
||
| 8 | #include "main.h" |
||
| 9 | #include "uart1.h" |
||
| 10 | #include "compass.h" |
||
| 11 | #include "spi_slave.h" |
||
| 12 | #include "triggerlog.h" |
||
| 13 | |||
| 14 | FromCamCtrl_t FromCamCtrl; |
||
| 15 | ToCamCtrl_t ToCamCtrl; |
||
| 16 | u16 CamCtrlTimeout = 25000; |
||
| 17 | |||
| 18 | void InitCamCtrl(void) |
||
| 19 | { |
||
| 20 | ToCamCtrl.CamCommand = 0; |
||
| 21 | ToCamCtrl.ZoomInput = 128; // Middle -> no zoom |
||
| 22 | ToCamCtrl.ControlInput = 0; |
||
| 23 | } |
||
| 24 | |||
| 25 | void CamCtrl_UpdateData(u8* pRxBuffer, u8 RxBufferSize) |
||
| 26 | { // if crc is ok and number of byte are matching |
||
| 27 | memcpy((u8 *)&FromCamCtrl, pRxBuffer, sizeof(FromCamCtrl)); |
||
| 28 | //if(FromCamCtrl.CamStatus & CAM_STATE_PIC_CAPTURED) |
||
| 29 | |||
| 30 | |||
| 31 | if(FromCamCtrl.CamStatus & CAM_STATE_REC_ACTIVE) CamCtrlCharacter = 'R'; |
||
| 32 | else if(FromCamCtrl.CamStatus & CAM_STATE_PHOTO_MODE) CamCtrlCharacter = 'P'; |
||
| 732 | holgerb | 33 | else if(FromCamCtrl.CamStatus & CAM_STATE_CAM_DISCONN) CamCtrlCharacter = '?'; |
| 728 | holgerb | 34 | else if(FromCamCtrl.CamStatus & CAM_STATE_OFF) CamCtrlCharacter = '!'; |
| 35 | else if(TrigLogging.CountExternal) CamCtrlCharacter = TrigLogging.CountExternal % 10 + '0'; |
||
| 36 | else if(FromCamCtrl.PhotoCount) CamCtrlCharacter = FromCamCtrl.PhotoCount % 10 + '0'; |
||
| 37 | else if(FromCamCtrl.CamStatus & CAM_STATE_RDY) CamCtrlCharacter = 'c'; |
||
| 38 | else CamCtrlCharacter = ' '; |
||
| 39 | |||
| 40 | // c = camera is ready |
||
| 41 | // R = Record active |
||
| 42 | // P = Cam in Photo mode (LANC Camcorders) |
||
| 43 | // ! = Camera is off but connected |
||
| 44 | // ? = disconnected |
||
| 45 | // 0-9 = Photo releases |
||
| 46 | |||
| 47 | if(FromCamCtrl.CamStatus & CAM_STATE_I2C_OK) CamCtrlTimeout = 3000; |
||
| 48 | } |
||
| 49 | |||
| 50 | void CamCtrl_GetData(u8 timeout) |
||
| 51 | { |
||
| 730 | holgerb | 52 | static u8 timing = 250, p63 = 0; |
| 732 | holgerb | 53 | static u8 force1photo = 0, delay ; // makes one photo when switching from Off to Photo |
| 728 | holgerb | 54 | |
| 55 | if(timing) |
||
| 56 | { |
||
| 57 | timing--; |
||
| 58 | } |
||
| 59 | else |
||
| 60 | // try to catch the I2C buffer within timeout ms |
||
| 61 | if(I2CBus_LockBuffer(I2C0, timeout)) |
||
| 62 | { |
||
| 63 | u8 TxBytes = 0, RxBytes = sizeof(FromCamCtrl); |
||
| 64 | TxBytes = 4; |
||
| 65 | // initiate transmission |
||
| 66 | ToCamCtrl.ZoomInput = 128 + PPM_In[EE_Parameter.CamCtrlZoomChannel]; |
||
| 67 | if(EE_Parameter.CamCtrlModeChannel) |
||
| 68 | { |
||
| 69 | if(PPM_In[EE_Parameter.CamCtrlModeChannel] > 50) // max |
||
| 70 | { |
||
| 71 | ToCamCtrl.CamCommand &= ~CAM_CMD_REC_OFF; |
||
| 72 | ToCamCtrl.CamCommand |= CAM_CMD_REC_ON; |
||
| 732 | holgerb | 73 | force1photo = 0; |
| 728 | holgerb | 74 | } |
| 75 | else |
||
| 76 | if(PPM_In[EE_Parameter.CamCtrlModeChannel] < -50) // min |
||
| 77 | { |
||
| 78 | ToCamCtrl.CamCommand &= ~CAM_CMD_REC_ON; |
||
| 79 | ToCamCtrl.CamCommand |= CAM_CMD_REC_OFF; |
||
| 732 | holgerb | 80 | force1photo = 1; |
| 81 | p63 = 0; |
||
| 82 | delay = 5; |
||
| 728 | holgerb | 83 | } |
| 84 | else // Middle |
||
| 732 | holgerb | 85 | { |
| 86 | if(delay) delay--; |
||
| 87 | else |
||
| 728 | holgerb | 88 | { |
| 732 | holgerb | 89 | if(force1photo || ((UART_VersionInfo.HWMajor >= 30) && TRIGGER_PP_INTERN) || ((UART_VersionInfo.HWMajor < 30) && (FC.StatusFlags2 & FC_STATUS2_OUT1_ACTIVE))) // internal Portpin or Flag |
| 728 | holgerb | 90 | { |
| 91 | if(!p63) ToCamCtrl.CamCommand |= CAM_CMD_SHUTTER; // combined with the FC trigger output |
||
| 92 | p63 = 1; |
||
| 732 | holgerb | 93 | force1photo = 0; |
| 728 | holgerb | 94 | } |
| 95 | else p63 = 0; |
||
| 96 | } |
||
| 732 | holgerb | 97 | } |
| 728 | holgerb | 98 | } |
| 99 | |||
| 100 | I2CBus_Transmission(I2C0, CAM_SLAVE_ADDRESS, &ToCamCtrl, TxBytes, &CamCtrl_UpdateData, RxBytes); |
||
| 101 | |||
| 102 | if(!EE_Parameter.CamCtrlModeChannel) ToCamCtrl.CamCommand = 0; // delete REC_OFF |
||
| 103 | ToCamCtrl.CamCommand = CAM_CMD_SWITCH_ON | (ToCamCtrl.CamCommand & (CAM_CMD_REC_ON | CAM_CMD_REC_OFF)); |
||
| 104 | timing = 66; // 66ms = 15Hz |
||
| 105 | } |
||
| 730 | holgerb | 106 | else timing = 11; // try again in 11ms |
| 728 | holgerb | 107 | } |