Subversion Repositories NaviCtrl

Rev

Rev 732 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed

Rev 732 Rev 733
Line 17... Line 17...
17
 
17
 
18
void InitCamCtrl(void)
18
void InitCamCtrl(void)
19
{
19
{
20
 ToCamCtrl.CamCommand = 0;
20
 ToCamCtrl.CamCommand = 0;
21
 ToCamCtrl.ZoomInput = 128; // Middle -> no zoom
-
 
22
 ToCamCtrl.ControlInput = 0;
21
 ToCamCtrl.ZoomInput = 128; // Middle -> no zoom
Line 23... Line 22...
23
}
22
}
24
 
23
 
25
void CamCtrl_UpdateData(u8* pRxBuffer, u8 RxBufferSize)
24
void CamCtrl_UpdateData(u8* pRxBuffer, u8 RxBufferSize)
Line 58... Line 57...
58
   }
57
   }
59
   else
58
   else
60
        // try to catch the I2C buffer within timeout ms
59
        // try to catch the I2C buffer within timeout ms
61
   if(I2CBus_LockBuffer(I2C0, timeout))
60
   if(I2CBus_LockBuffer(I2C0, timeout))
62
        {
61
        {
63
                u8 TxBytes = 0, RxBytes = sizeof(FromCamCtrl);
62
                u8 RxBytes = sizeof(FromCamCtrl);
64
                TxBytes = 4;
-
 
65
                // initiate transmission
63
                // initiate transmission
66
                ToCamCtrl.ZoomInput = 128 + PPM_In[EE_Parameter.CamCtrlZoomChannel];
64
                ToCamCtrl.ZoomInput = 128 + PPM_In[EE_Parameter.CamCtrlZoomChannel];
67
                if(EE_Parameter.CamCtrlModeChannel)
65
                if(EE_Parameter.CamCtrlModeChannel)
68
                 {
66
                 {
69
                        if(PPM_In[EE_Parameter.CamCtrlModeChannel] > 50)        // max
67
                        if(PPM_In[EE_Parameter.CamCtrlModeChannel] > 50)        // max
Line 95... Line 93...
95
                                 else p63 = 0;
93
                                 else p63 = 0;
96
                           }
94
                           }
97
                          }
95
                          }
98
                }
96
                }
Line 99... Line 97...
99
 
97
 
Line 100... Line 98...
100
        I2CBus_Transmission(I2C0, CAM_SLAVE_ADDRESS, &ToCamCtrl, TxBytes, &CamCtrl_UpdateData, RxBytes);
98
        I2CBus_Transmission(I2C0, CAM_SLAVE_ADDRESS, &ToCamCtrl, sizeof(ToCamCtrl), &CamCtrl_UpdateData, RxBytes);
101
 
99
 
102
        if(!EE_Parameter.CamCtrlModeChannel) ToCamCtrl.CamCommand = 0; // delete REC_OFF
100
        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));
101
        ToCamCtrl.CamCommand = CAM_CMD_SWITCH_ON | (ToCamCtrl.CamCommand & (CAM_CMD_REC_ON | CAM_CMD_REC_OFF));