0,0 → 1,87 |
/* EOS Focus control demo */ |
/* Tested with 7D */ |
#include <inttypes.h> |
#include <avr/pgmspace.h> |
|
//#include <Spi.h> |
#include <Max3421e.h> |
#include <Max3421e_constants.h> |
#include <Max_LCD.h> |
#include <Usb.h> |
|
#include <ptp.h> |
#include <canoneos.h> |
|
#define DEV_ADDR 1 |
|
// Canon EOS 400D |
#define DATA_IN_EP 1 |
#define DATA_OUT_EP 2 |
#define INTERRUPT_EP 3 |
#define CONFIG_NUM 1 |
|
class CamStateHandlers : public EOSStateHandlers |
{ |
enum CamStates { stInitial, stDisconnected, stConnected }; |
CamStates stateConnected; |
|
public: |
CamStateHandlers() : stateConnected(stInitial) |
{ |
}; |
|
virtual void OnDeviceDisconnectedState(PTP *ptp); |
virtual void OnDeviceInitializedState(PTP *ptp); |
}; |
|
CamStateHandlers CamStates; |
CanonEOS Eos(DEV_ADDR, DATA_IN_EP, DATA_OUT_EP, INTERRUPT_EP, CONFIG_NUM, &CamStates); |
|
void setup() { |
Serial.begin( 115200 ); |
Serial.println("Start"); |
Eos.Setup(); |
delay( 200 ); |
} |
|
void loop() |
{ |
Eos.Task(); |
} |
|
void CamStateHandlers::OnDeviceDisconnectedState(PTP *ptp) |
{ |
if (stateConnected == stConnected || stateConnected == stInitial) |
{ |
stateConnected = stDisconnected; |
Notify(PSTR("Camera disconnected.\r\n")); |
} |
} |
|
void CamStateHandlers::OnDeviceInitializedState(PTP *ptp) |
{ |
if (stateConnected == stDisconnected) |
{ |
stateConnected = stConnected; |
|
// Switch LiveView on |
Eos.SwitchLiveView(true); |
delay(50); |
|
for (uint8_t i=0; i<10; i++) |
{ |
if (i > 4) |
Eos.MoveFocus(3); |
else |
Eos.MoveFocus(0x8003); |
|
delay(100); |
Eos.Capture(); |
delay(1500); |
} |
|
// Switch LiveView off |
Eos.SwitchLiveView(false); |
} |
} |
|