devices/devicecamera/ordevicecamera_device.cxx

devices/devicecamera/ordevicecamera_device.cxx
/***************************************************************************************
Autodesk(R) Open Reality(R) Samples
(C) 2009 Autodesk, Inc. and/or its licensors
All rights reserved.
AUTODESK SOFTWARE LICENSE AGREEMENT
Autodesk, Inc. licenses this Software to you only upon the condition that
you accept all of the terms contained in the Software License Agreement ("Agreement")
that is embedded in or that is delivered with this Software. By selecting
the "I ACCEPT" button at the end of the Agreement or by copying, installing,
uploading, accessing or using all or any portion of the Software you agree
to enter into the Agreement. A contract is then formed between Autodesk and
either you personally, if you acquire the Software for yourself, or the company
or other legal entity for which you are acquiring the software.
AUTODESK, INC., MAKES NO WARRANTY, EITHER EXPRESS OR IMPLIED, INCLUDING BUT
NOT LIMITED TO ANY IMPLIED WARRANTIES OF MERCHANTABILITY OR FITNESS FOR A PARTICULAR
PURPOSE REGARDING THESE MATERIALS, AND MAKES SUCH MATERIALS AVAILABLE SOLELY ON AN
"AS-IS" BASIS.
IN NO EVENT SHALL AUTODESK, INC., BE LIABLE TO ANYONE FOR SPECIAL, COLLATERAL,
INCIDENTAL, OR CONSEQUENTIAL DAMAGES IN CONNECTION WITH OR ARISING OUT OF PURCHASE
OR USE OF THESE MATERIALS. THE SOLE AND EXCLUSIVE LIABILITY TO AUTODESK, INC.,
REGARDLESS OF THE FORM OF ACTION, SHALL NOT EXCEED THE PURCHASE PRICE OF THE
MATERIALS DESCRIBED HEREIN.
Autodesk, Inc., reserves the right to revise and improve its products as it sees fit.
Autodesk and Open Reality are registered trademarks or trademarks of Autodesk, Inc.,
in the U.S.A. and/or other countries. All other brand names, product names, or
trademarks belong to their respective holders.
GOVERNMENT USE
Use, duplication, or disclosure by the U.S. Government is subject to restrictions as
set forth in FAR 12.212 (Commercial Computer Software-Restricted Rights) and
DFAR 227.7202 (Rights in Technical Data and Computer Software), as applicable.
Manufacturer is Autodesk, Inc., 10 Duke Street, Montreal, Quebec, Canada, H3C 2L7.
***************************************************************************************/
//--- Class declaration
#include "ordevicecamera_device.h"
#include <math.h>
//--- Registration defines
#define ORDEVICECAMERATEMPLATE__CLASS ORDEVICECAMERATEMPLATE__CLASSNAME
#define ORDEVICECAMERATEMPLATE__NAME ORDEVICECAMERATEMPLATE__CLASSSTR
#define ORDEVICECAMERATEMPLATE__LABEL "OR - Camera Tracker Template"
#define ORDEVICECAMERATEMPLATE__DESC "OR - Camera Tracker Template Description"
#define ORDEVICECAMERATEMPLATE__PREFIX "CameraTracker"
#define ORDEVICECAMERATEMPLATE__ICON "devices_camera_tracker.png"
//--- FiLMBOX implementation and registration
FBDeviceImplementation ( ORDEVICECAMERATEMPLATE__CLASS );
FBRegisterDevice ( ORDEVICECAMERATEMPLATE__NAME,
ORDEVICECAMERATEMPLATE__CLASS,
ORDEVICECAMERATEMPLATE__LABEL,
ORDEVICECAMERATEMPLATE__DESC,
ORDEVICECAMERATEMPLATE__ICON );
/************************************************
* FiLMBOX Constructor.
************************************************/
bool ORDeviceCamera_Template::FBCreate()
{
mHardware.SetDevice( this );
ModelTemplatePrefix = ORDEVICECAMERATEMPLATE__PREFIX;
PacketBufferSize = 100;
CommType = kFBCommTypeSimulator;
SyncDelay = 4;
mFirstPacket = true;
if( FBDeviceCamera::FBCreate() )
{
// Create my animation nodes
mNodeCamera_InData = AnimationNodeOutCreate( 0, "Data", ANIMATIONNODE_TYPE_NUMBER );
// Set sampling rate to be on external (or video) sync
FBTime lPeriod(0);
SamplingPeriod = lPeriod;
SamplingMode = kFBHardwareTimestamp;
// Register packets in packetbuffer
for( int i=0; i<PacketBufferSize; i++ )
{
FBDeviceSync::PacketRegister( new ORDeviceCamera_Template_Packet );
}
return true;
}
return false;
}
/************************************************
* FiLMBOX Destructor.
************************************************/
void ORDeviceCamera_Template::FBDestroy()
{
while( FBDeviceSync::PacketGetCount() > 0 )
{
ORDeviceCamera_Template_Packet* lPacket = (ORDeviceCamera_Template_Packet*)FBDeviceSync::PacketRemove(0);
delete lPacket;
}
FBDeviceCamera::FBDestroy();
}
/************************************************
* Device operation.
************************************************/
bool ORDeviceCamera_Template::DeviceOperation( kDeviceOperations pOperation )
{
switch (pOperation)
{
case kOpInit: return Init();
case kOpStart: return Start();
case kOpStop: return Stop();
case kOpReset: Stop(); return Start();
case kOpDone: return Done();
}
return FBDeviceCamera::DeviceOperation( pOperation );
}
/************************************************
* Initialization of device.
************************************************/
bool ORDeviceCamera_Template::Init()
{
FBProgress lProgress;
lProgress.Caption = "Initializing Device";
// Step 1: Init device communications
lProgress.Text = "Initializing device...";
Status = "Initializing device...";
if(!mHardware.Init())
{
lProgress.Text = "Could not open device!";
Status = "Could not open device!";
return false;
}
lProgress.Text = "Device Initialized.";
Status = "Device Initialized.";
return true;
}
/************************************************
* Device is put online.
************************************************/
bool ORDeviceCamera_Template::Start()
{
FBProgress lProgress;
lProgress.Caption = "Device Startup";
// Step 1: Open device communications
lProgress.Text = "Opening device communications...";
Status = "Opening device communications...";
if(!mHardware.Open())
{
lProgress.Text = "Opening device communications";
Status = "Opening device communications";
return false;
}
// Step 2: Get device information
lProgress.Text = "Getting Setup Info...";
Status = "Getting Setup Info...";
if(!mHardware.GetSetupInfo())
{
lProgress.Text = "Could not get setup info!";
Status = "Could not get setup info!";
return false;
}
// Step 3: Start data stream.
lProgress.Text = "Starting Streaming Mode...";
Status = "Starting Streaming Mode...";
if(!mHardware.StartDataStream())
{
lProgress.Text = "Could not start streaming!";
Status = "Could not start streaming!";
return false;
}
lProgress.Text = "Device started.";
Status = "Ok.";
return true;
}
/************************************************
* Device is stopped (offline).
************************************************/
bool ORDeviceCamera_Template::Stop()
{
FBProgress lProgress;
lProgress.Caption = "Device Shutdown";
// Step 1: Stop streaming data
lProgress.Text = "Stopping device streaming";
Status = "Stopping device streaming";
if(!mHardware.StopDataStream())
{
Status = "Could not stop streaming";
return false;
}
// Step 2: Close communications
lProgress.Text = "Stopping device communications";
Status = "Stopping device communications";
if(!mHardware.Close())
{
Status = "Could not close device";
return false;
}
Status = "?";
return false;
}
/************************************************
* Removal of device.
************************************************/
bool ORDeviceCamera_Template::Done()
{
FBProgress lProgress;
lProgress.Caption = "Device Removal";
// Step 1: Stop hardware
lProgress.Text = "Stopping device...";
Status = "Stopping device...";
if(!mHardware.Close())
{
lProgress.Text = "Could not stop device!";
Status = "Could not stop device!";
return true;
}
Status = "?";
return false;
}
/************************************************
* Real-Time Engine Evaluation.
************************************************/
bool ORDeviceCamera_Template::DeviceSyncAnimationNodeNotify(FBAnimationNode* pAnimationNode ,FBEvaluateInfo* pEvaluateInfo, int pCorrectedSync)
{
// Parent call
FBDeviceCamera::DeviceSyncAnimationNodeNotify( pAnimationNode, pEvaluateInfo, pCorrectedSync);
// Continue for custom data.
ORDeviceCamera_Template_Packet* lPacket = (ORDeviceCamera_Template_Packet*) FBDeviceSync::PacketFetch( pCorrectedSync );
if( lPacket )
{
mNodeCamera_InData->WriteData( &(lPacket->Data), pEvaluateInfo );
}
FBDeviceSync::PacketRelease( lPacket );
return true;
}
/************************************************
* Real-Time Synchronous Device IO.
************************************************/
void ORDeviceCamera_Template::DeviceIONotify( kDeviceIOs pAction,FBDeviceNotifyInfo &pDeviceNotifyInfo)
{
FBDeviceCamera::DeviceIONotify( pAction, pDeviceNotifyInfo );
}
/************************************************
* Camera hardware IO.
************************************************/
void ORDeviceCamera_Template::DeviceCameraEvalData( FBDeviceNotifyInfo &pDeviceNotifyInfo )
{
int lSyncCount = pDeviceNotifyInfo.GetSyncCount();
int lPacketCount = 0;
FBTime lRecordTime;
// Lock a packet
ORDeviceCamera_Template_Packet* lPacket = (ORDeviceCamera_Template_Packet*)FBDeviceSync::PacketLock();
{
while( lPacket && mHardware.FetchDataPacket() )
{
// Debug info
PrintDebugIOInfo( lPacket, pDeviceNotifyInfo );
// Store packet
lPacket->OriginalSync = lSyncCount;
lPacket->DeviceSync = mHardware.GetSync();
lPacket->Position = mHardware.GetPosition();
lPacket->Rotation = mHardware.GetRotation();
lPacket->Focus = mHardware.GetFocus();
lPacket->Zoom = mHardware.GetZoom();
lPacket->Data = mHardware.GetData();
lPacket->Time = mHardware.GetTime();
//
// Set instrument packet in order to create the fcurve keys when recording
//
ORDeviceCamera_Template_Packet* lRecPacket = (ORDeviceCamera_Template_Packet*) FBDeviceSync::PacketFetch( lSyncCount-SyncDelay );
if( lRecPacket )
{
// Establish the FiLMBOX recording time
if( mNodeCamera_InData->GetAnimationToRecord() )
{
if( mFirstPacket )
{
mFirstPacket = false;
mRecordStartTime = pDeviceNotifyInfo.GetLocalTime();
mFirstPacketTime = lRecPacket->Time;
}
}
FBDeviceCameraInstrument* lInstrument = (FBDeviceCameraInstrument*)Instruments[0];
FBDeviceCameraPacket* lIPacket = lInstrument->RecordPacket;
// Copy the generic stuff
lIPacket->Position = FBVector3d( lRecPacket->Position );
lIPacket->Rotation = FBVector3d( lRecPacket->Rotation );
lIPacket->FieldOfView = FBVector2d( lRecPacket->FieldOfView );
lIPacket->OpticalCenter = FBVector2d( lRecPacket->OpticalCenter );
lIPacket->Focus = (double)lRecPacket->Focus;
lIPacket->Zoom = (double)lRecPacket->Zoom;
lRecordTime = (lRecPacket->Time-mFirstPacketTime) + mRecordStartTime;
DeviceCameraRecordFrame( lRecordTime , pDeviceNotifyInfo, lRecPacket );
FBDeviceSync::PacketRelease( lRecPacket );
}
AckOneSampleReceived();
// Cleanup & prep for next packet
lPacketCount++;
FBDeviceSync::PacketUnlock( lPacket, true );
lPacket = (ORDeviceCamera_Template_Packet*)FBDeviceSync::PacketLock();
}
}
// If a packet is still locked, free packet
if( lPacket )
{
FBDeviceSync::PacketUnlock(lPacket, false);
}
PrintDebugIONotifyInfo( pDeviceNotifyInfo, lPacketCount );
}
void ORDeviceCamera_Template::DeviceCameraRecordFrame( FBTime &pTime, FBDeviceNotifyInfo& pNotifyInfo, ORDeviceCamera_Template_Packet* pPacket )
{
// Parent call
FBDeviceCamera::DeviceCameraRecordFrame( pTime, pNotifyInfo );
// Continue with custom data
if( mPlayerControl.GetTransportMode() == kFBTransportPlay )
{
FBAnimationNode* lData;
lData = mNodeCamera_InData->GetAnimationToRecord();
if( lData )
{
lData->KeyAdd( pTime, &(pPacket->Data) );
}
}
}
void ORDeviceCamera_Template::RecordingDoneAnimation( FBAnimationNode* pAnimationNode )
{
// Parent call
FBDeviceCamera::RecordingDoneAnimation( pAnimationNode );
mFirstPacket = true;
}
/************************************************
* Add new model binding.
************************************************/
bool ORDeviceCamera_Template::ModelTemplateBindNotify( FBModel* pModel, int pIndex, FBModelTemplate* pModelTemplate )
{
static int lOnMyWayOut = 0;
if( pModel )
{
if( !GetObjectStatus(kFBStatusRetrieving) && pModel->Is( FBCamera::TypeInfo ) )
{
FBCamera* lCamera = (FBCamera*) pModel;
FBColor lColor;
lColor[0] = 0.30;
lColor[1] = 0.30;
lColor[2] = 0.30;
//lCamera->ResolutionMode = kFBResolutionD1PAL;
lCamera->BackGroundTexture = mSystem.Scene->Textures.GetCount()>0 ? mSystem.Scene->Textures[0]:NULL;
lCamera->ViewShowGrid = false;
lCamera->UseFrameColor = true;
lCamera->FrameColor = lColor;
lCamera->ViewOpticalCenter = true;
}
}
// Recursive propagation to children.
for ( int Count=0; Count<pModel->Children.GetCount(); Count++)
{
lOnMyWayOut++;
ORDeviceCamera_Template::ModelTemplateBindNotify( pModel->Children[Count], pIndex, pModelTemplate );
}
if( lOnMyWayOut==0 )
{
FBDeviceCamera::ModelTemplateBindNotify( pModel, pIndex, pModelTemplate );
}
else
{
lOnMyWayOut--;
}
return true;
}
#define CAMERATEMPLATE_VERSION_351 0x0351
//#define RADAMEC_VERSION_400 0x0400
#define CAMERATEMPLATE_VERSION_NUMBER CAMERATEMPLATE_VERSION_351
#define CAMERATEMPLATE_FBX_VERSION "Version"
#define CAMERATEMPLATE_FBX_SERIAL "Serial"
#define CAMERATEMPLATE_FBX_SIMULATOR "Simulator"
#define CAMERATEMPLATE_FBX_NETWORK "Network"
#define CAMERATEMPLATE_FBX_SHAREDMEM "SharedMemory"
#define CAMERATEMPLATE_FBX_SETTINGS "Settings"
/************************************************
* Store data in FBX.
************************************************/
bool ORDeviceCamera_Template::FbxStore(FBFbxObject* pFbxObject,kFbxObjectStore pStoreWhat)
{
if (pStoreWhat & kAttributes)
{
pFbxObject->FieldWriteI(CAMERATEMPLATE_FBX_VERSION, CAMERATEMPLATE_VERSION_NUMBER);
pFbxObject->FieldWriteBegin(CAMERATEMPLATE_FBX_SERIAL);
{
pFbxObject->FieldWriteI(this->GetSerialPort());
pFbxObject->FieldWriteI(this->GetSerialBaudRate());
}
pFbxObject->FieldWriteEnd();
pFbxObject->FieldWriteBegin(CAMERATEMPLATE_FBX_SIMULATOR);
{
pFbxObject->FieldWriteD(this->GetSimulatorFrequency());
pFbxObject->FieldWriteD(this->GetSimulatorAmplitude());
pFbxObject->FieldWriteD(this->GetSimulatorZoom());
pFbxObject->FieldWriteD(this->GetSimulatorFocus());
}
pFbxObject->FieldWriteEnd();
pFbxObject->FieldWriteBegin(CAMERATEMPLATE_FBX_NETWORK);
{
pFbxObject->FieldWriteC( this->GetNetworkAddress() );
pFbxObject->FieldWriteI( this->GetNetworkPort() );
}
pFbxObject->FieldWriteEnd();
pFbxObject->FieldWriteBegin(CAMERATEMPLATE_FBX_SHAREDMEM);
{
pFbxObject->FieldWriteC( this->GetSharedMemoryHandle() );
char lBuffer[255];
sprintf( lBuffer, "%#06lx", this->GetSharedMemoryAddress() );
pFbxObject->FieldWriteC( lBuffer );
}
pFbxObject->FieldWriteEnd();
pFbxObject->FieldWriteBegin(CAMERATEMPLATE_FBX_SETTINGS);
{
pFbxObject->FieldWriteD( this->GetHardwareSetting() );
}
pFbxObject->FieldWriteEnd();
}
return FBDeviceCamera::FbxStore( pFbxObject, pStoreWhat );
}
/************************************************
* Retrieve data from FBX.
************************************************/
bool ORDeviceCamera_Template::FbxRetrieve(FBFbxObject* pFbxObject,kFbxObjectStore pStoreWhat)
{
int lVersion;
if (pStoreWhat & kAttributes)
{
lVersion = pFbxObject->FieldReadI(CAMERATEMPLATE_FBX_VERSION);
if( lVersion >= CAMERATEMPLATE_VERSION_351 )
{
if(pFbxObject->FieldReadBegin(CAMERATEMPLATE_FBX_SERIAL))
{
this->SetSerialPort ( pFbxObject->FieldReadI() );
this->SetSerialBaudRate ( pFbxObject->FieldReadI() );
pFbxObject->FieldReadEnd();
}
if(pFbxObject->FieldReadBegin(CAMERATEMPLATE_FBX_SIMULATOR))
{
this->SetSimulatorFrequency ( pFbxObject->FieldReadD() );
this->SetSimulatorAmplitude ( pFbxObject->FieldReadD() );
this->SetSimulatorZoom ( pFbxObject->FieldReadD() );
this->SetSimulatorFocus ( pFbxObject->FieldReadD() );
pFbxObject->FieldReadEnd();
}
if(pFbxObject->FieldReadBegin(CAMERATEMPLATE_FBX_NETWORK) )
{
this->SetNetworkAddress ( pFbxObject->FieldReadC() );
this->SetNetworkPort ( pFbxObject->FieldReadI() );
pFbxObject->FieldReadEnd();
}
if(pFbxObject->FieldReadBegin(CAMERATEMPLATE_FBX_SHAREDMEM) )
{
this->SetSharedMemoryHandle( pFbxObject->FieldReadC() );
char lBuffer[255];
kReference lAddress;
sprintf(lBuffer, "%s", pFbxObject->FieldReadC());
sscanf( lBuffer, "%lx", &lAddress);
this->SetSharedMemoryAddress( lAddress );
pFbxObject->FieldReadEnd();
}
if(pFbxObject->FieldReadBegin(CAMERATEMPLATE_FBX_SETTINGS))
{
this->SetHardwareSetting( pFbxObject->FieldReadD() );
pFbxObject->FieldReadEnd();
}
}
}
return FBDeviceCamera::FbxRetrieve( pFbxObject, pStoreWhat );
}
Please send us your comment about this page