Rev 790 | 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; |
||
790 | holgerb | 16 | FromLaserCtrl_t FromLaserCtrl; |
17 | ToLaserCtrl_t ToLaserCtrl; |
||
18 | |||
728 | holgerb | 19 | u16 CamCtrlTimeout = 25000; |
790 | holgerb | 20 | u16 LaserCtrlTimeout = 5000; |
728 | holgerb | 21 | |
22 | void InitCamCtrl(void) |
||
23 | { |
||
24 | ToCamCtrl.CamCommand = 0; |
||
25 | ToCamCtrl.ZoomInput = 128; // Middle -> no zoom |
||
26 | } |
||
27 | |||
28 | void CamCtrl_UpdateData(u8* pRxBuffer, u8 RxBufferSize) |
||
29 | { // if crc is ok and number of byte are matching |
||
30 | memcpy((u8 *)&FromCamCtrl, pRxBuffer, sizeof(FromCamCtrl)); |
||
31 | //if(FromCamCtrl.CamStatus & CAM_STATE_PIC_CAPTURED) |
||
32 | |||
33 | |||
34 | if(FromCamCtrl.CamStatus & CAM_STATE_REC_ACTIVE) CamCtrlCharacter = 'R'; |
||
35 | else if(FromCamCtrl.CamStatus & CAM_STATE_PHOTO_MODE) CamCtrlCharacter = 'P'; |
||
732 | holgerb | 36 | else if(FromCamCtrl.CamStatus & CAM_STATE_CAM_DISCONN) CamCtrlCharacter = '?'; |
728 | holgerb | 37 | else if(FromCamCtrl.CamStatus & CAM_STATE_OFF) CamCtrlCharacter = '!'; |
38 | else if(TrigLogging.CountExternal) CamCtrlCharacter = TrigLogging.CountExternal % 10 + '0'; |
||
39 | else if(FromCamCtrl.PhotoCount) CamCtrlCharacter = FromCamCtrl.PhotoCount % 10 + '0'; |
||
40 | else if(FromCamCtrl.CamStatus & CAM_STATE_RDY) CamCtrlCharacter = 'c'; |
||
41 | else CamCtrlCharacter = ' '; |
||
42 | |||
43 | // c = camera is ready |
||
44 | // R = Record active |
||
45 | // P = Cam in Photo mode (LANC Camcorders) |
||
46 | // ! = Camera is off but connected |
||
47 | // ? = disconnected |
||
48 | // 0-9 = Photo releases |
||
49 | |||
50 | if(FromCamCtrl.CamStatus & CAM_STATE_I2C_OK) CamCtrlTimeout = 3000; |
||
51 | } |
||
52 | |||
53 | void CamCtrl_GetData(u8 timeout) |
||
54 | { |
||
730 | holgerb | 55 | static u8 timing = 250, p63 = 0; |
732 | holgerb | 56 | static u8 force1photo = 0, delay ; // makes one photo when switching from Off to Photo |
728 | holgerb | 57 | |
58 | if(timing) |
||
59 | { |
||
60 | timing--; |
||
61 | } |
||
62 | else |
||
63 | // try to catch the I2C buffer within timeout ms |
||
64 | if(I2CBus_LockBuffer(I2C0, timeout)) |
||
65 | { |
||
733 | holgerb | 66 | u8 RxBytes = sizeof(FromCamCtrl); |
728 | holgerb | 67 | // initiate transmission |
68 | ToCamCtrl.ZoomInput = 128 + PPM_In[EE_Parameter.CamCtrlZoomChannel]; |
||
69 | if(EE_Parameter.CamCtrlModeChannel) |
||
70 | { |
||
71 | if(PPM_In[EE_Parameter.CamCtrlModeChannel] > 50) // max |
||
72 | { |
||
73 | ToCamCtrl.CamCommand &= ~CAM_CMD_REC_OFF; |
||
74 | ToCamCtrl.CamCommand |= CAM_CMD_REC_ON; |
||
732 | holgerb | 75 | force1photo = 0; |
728 | holgerb | 76 | } |
77 | else |
||
78 | if(PPM_In[EE_Parameter.CamCtrlModeChannel] < -50) // min |
||
79 | { |
||
80 | ToCamCtrl.CamCommand &= ~CAM_CMD_REC_ON; |
||
81 | ToCamCtrl.CamCommand |= CAM_CMD_REC_OFF; |
||
732 | holgerb | 82 | force1photo = 1; |
83 | p63 = 0; |
||
84 | delay = 5; |
||
728 | holgerb | 85 | } |
86 | else // Middle |
||
732 | holgerb | 87 | { |
88 | if(delay) delay--; |
||
89 | else |
||
728 | holgerb | 90 | { |
732 | holgerb | 91 | 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 | 92 | { |
93 | if(!p63) ToCamCtrl.CamCommand |= CAM_CMD_SHUTTER; // combined with the FC trigger output |
||
94 | p63 = 1; |
||
732 | holgerb | 95 | force1photo = 0; |
728 | holgerb | 96 | } |
97 | else p63 = 0; |
||
98 | } |
||
732 | holgerb | 99 | } |
728 | holgerb | 100 | } |
101 | |||
733 | holgerb | 102 | I2CBus_Transmission(I2C0, CAM_SLAVE_ADDRESS, &ToCamCtrl, sizeof(ToCamCtrl), &CamCtrl_UpdateData, RxBytes); |
728 | holgerb | 103 | |
104 | if(!EE_Parameter.CamCtrlModeChannel) ToCamCtrl.CamCommand = 0; // delete REC_OFF |
||
105 | ToCamCtrl.CamCommand = CAM_CMD_SWITCH_ON | (ToCamCtrl.CamCommand & (CAM_CMD_REC_ON | CAM_CMD_REC_OFF)); |
||
106 | timing = 66; // 66ms = 15Hz |
||
107 | } |
||
730 | holgerb | 108 | else timing = 11; // try again in 11ms |
728 | holgerb | 109 | } |
790 | holgerb | 110 | |
111 | void LaserCtrl_UpdateData(u8* pRxBuffer, u8 RxBufferSize) |
||
112 | { // if crc is ok and number of byte are matching |
||
113 | memcpy((u8 *)&FromLaserCtrl, pRxBuffer, sizeof(FromLaserCtrl)); |
||
114 | DebugOut.Analog[13] = FromLaserCtrl.Distance; |
||
115 | if((FromLaserCtrl.LaserStatus & LASER_DATA_OK) && (FromLaserCtrl.Distance == 0)) FromLaserCtrl.Distance = 1; // just to mark that the value is active (0 -> not connected) |
||
116 | LaserCtrlTimeout = 3000; |
||
117 | } |
||
118 | |||
119 | |||
120 | void LaserCtrl_GetData(u8 timeout) |
||
121 | { |
||
122 | static u8 timing = 250; |
||
123 | |||
124 | if(timing) |
||
125 | { |
||
126 | timing--; |
||
127 | } |
||
128 | else |
||
129 | // try to catch the I2C buffer within timeout ms |
||
130 | if(I2CBus_LockBuffer(I2C0, timeout)) |
||
131 | { |
||
132 | u8 RxBytes = 3;//sizeof(FromLaserCtrl); |
||
133 | // initiate transmission |
||
134 | I2CBus_Transmission(I2C0, LASER_SLAVE_ADDRESS, &ToLaserCtrl, sizeof(ToLaserCtrl), &LaserCtrl_UpdateData, RxBytes); |
||
135 | timing = 66; // 66ms = 15Hz |
||
136 | } |
||
137 | else timing = 11; // try again in 11ms |
||
138 | } |
||
139 |