• MikroKopter.de
• Wiki
• SHOP
• Datenschutz
• Impressum

NaviCtrlBL-CtrlFlightCtrlMK3MagProjects

Català-Valencià – Catalan中文 – Chinese (Simplified)中文 – Chinese (Traditional)Česky – CzechDansk – DanishNederlands – DutchEnglish – EnglishSuomi – FinnishFrançais – FrenchDeutsch – Germanעברית – Hebrewहिंदी – HindiMagyar – HungarianBahasa Indonesia – IndonesianItaliano – Italian日本語 – Japanese한국어 – KoreanМакедонски – Macedonianमराठी – MarathiNorsk – NorwegianPolski – PolishPortuguês – PortuguesePortuguês – Portuguese (Brazil)Русский – RussianSlovenčina – SlovakSlovenščina – SlovenianEspañol – SpanishSvenska – SwedishTürkçe – TurkishУкраїнська – UkrainianOëzbekcha – Uzbek

Compare Revisions

• This comparison shows the changes necessary to convert path

  → / @ 789

  → / @ 790

  ↔ Reverse comparison

• Compare Path:	Rev

  With Path:	Rev

Ignore whitespace Rev 789 → Rev 790

/trunk/CamCtrl.c
13,7 → 13,11
FromCamCtrl_t FromCamCtrl;
ToCamCtrl_t ToCamCtrl;
FromLaserCtrl_t FromLaserCtrl;
ToLaserCtrl_t ToLaserCtrl;
u16 CamCtrlTimeout = 25000;
u16 LaserCtrlTimeout = 5000;
void InitCamCtrl(void)
{
103,3 → 107,33
}
else timing = 11; // try again in 11ms
}
void LaserCtrl_UpdateData(u8* pRxBuffer, u8 RxBufferSize)
{ // if crc is ok and number of byte are matching
memcpy((u8 *)&FromLaserCtrl, pRxBuffer, sizeof(FromLaserCtrl));
DebugOut.Analog[13] = FromLaserCtrl.Distance;
if((FromLaserCtrl.LaserStatus & LASER_DATA_OK) && (FromLaserCtrl.Distance == 0)) FromLaserCtrl.Distance = 1; // just to mark that the value is active (0 -> not connected)
LaserCtrlTimeout = 3000;
}
void LaserCtrl_GetData(u8 timeout)
{
static u8 timing = 250;
if(timing)
{
timing--;
}
else
// try to catch the I2C buffer within timeout ms
if(I2CBus_LockBuffer(I2C0, timeout))
{
u8 RxBytes = 3;//sizeof(FromLaserCtrl);
// initiate transmission
I2CBus_Transmission(I2C0, LASER_SLAVE_ADDRESS, &ToLaserCtrl, sizeof(ToLaserCtrl), &LaserCtrl_UpdateData, RxBytes);
timing = 66; // 66ms = 15Hz
}
else timing = 11; // try again in 11ms
}

/trunk/CamCtrl.h
2,6 → 2,7
#define __CAMCTRL_H
#define CAM_SLAVE_ADDRESS 0x26
#define LASER_SLAVE_ADDRESS 0x24
// FromCamCtrl.CamStatus
#define CAM_STATE_RDY 0x80 // The camera seems to be ready
14,6 → 15,10
#define CAM_STATE_PIC_CAPTURED 0x01 // Bit for captured one Photo recently
//FromLaserCtrl.LaserStatus
#define LASER_DATA_OK 0x01
#define LASER_I2C_OK 0x80
// ToCamCtrl.CamCommand
#define CAM_CMD_SWITCH_ON 0x80
#define CAM_CMD_SWITCH_OFF 0x40
52,9 → 57,36
u8 dummy2;
} __attribute__((packed)) ToCamCtrl_t;
extern ToCamCtrl_t ToCamCtrl;
typedef struct
{
u8 LaserStatus;
u16 Distance;
u8 free1;
u8 PPM1Okay;
u8 PPM1Data;
u8 PPM2Okay;
u8 PPM2Data;
u8 Type;
u8 Version; // 4 = V1.04 104 = V2.04
u8 Compatible;
} __attribute__((packed)) FromLaserCtrl_t;
extern FromLaserCtrl_t FromLaserCtrl;
typedef struct
{
u8 CamCommand;
u8 ZoomInput;
u8 dummy;
u8 dummy2;
} __attribute__((packed)) ToLaserCtrl_t;
extern ToLaserCtrl_t ToLaserCtrl;
void CamCtrl_GetData(u8);
void InitCamCtrl(void);
extern u16 CamCtrlTimeout;
void CamCtrl_UpdateData(u8* pRxBuffer, u8 RxBufferSize);
extern u16 LaserCtrlTimeout;
extern void CamCtrl_UpdateData(u8* pRxBuffer, u8 RxBufferSize);
extern void LaserCtrl_UpdateData(u8* pRxBuffer, u8 RxBufferSize);
#endif // __CAMCTRL_H