00001 /* ======================================================================== 00002 * Copyright (c) 2006, 00003 * Institute for Computer Graphics and Vision 00004 * Graz University of Technology 00005 * All rights reserved. 00006 * 00007 * Redistribution and use in source and binary forms, with or without 00008 * modification, are permitted provided that the following conditions are 00009 * met: 00010 * 00011 * Redistributions of source code must retain the above copyright notice, 00012 * this list of conditions and the following disclaimer. 00013 * 00014 * Redistributions in binary form must reproduce the above copyright 00015 * notice, this list of conditions and the following disclaimer in the 00016 * documentation and/or other materials provided with the distribution. 00017 * 00018 * Neither the name of the Graz University of Technology nor the names of 00019 * its contributors may be used to endorse or promote products derived from 00020 * this software without specific prior written permission. 00021 * 00022 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS 00023 * IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED 00024 * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A 00025 * PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER 00026 * OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, 00027 * EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, 00028 * PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR 00029 * PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF 00030 * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING 00031 * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS 00032 * SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 00033 * ======================================================================== 00034 * PROJECT: OpenTracker 00035 * ======================================================================== */ 00042 /* ======================================================================= */ 00043 00056 #ifndef _PANTILTUNITSINKSOURCE_H 00057 #define _PANTILTUNITSINKSOURCE_H 00058 00059 #include <stdio.h> 00060 #include <queue> 00061 00062 00063 #include "../OpenTracker.h" 00064 #include "../common/ConsoleSource.h" 00065 00066 #ifdef USE_PANTILTUNIT 00067 00068 #include <ptuDll.h> 00069 #pragma comment(lib,"ptudlld") 00070 00071 #include "Lanc.h" 00072 #include "PtuCallback.h" 00073 00074 00075 namespace ot { 00076 00083 class OPENTRACKER_API PanTiltUnitSinkSource : public Node 00084 { 00085 // Members 00086 public: 00088 Event event; 00089 00093 virtual int isEventGenerator() 00094 { 00095 return 1; 00096 } 00097 00099 void push(); 00100 00101 // The COM port where the PTU is connected 00102 bool initComPort(int comPort); 00103 00104 void closeComPort(); 00105 00106 PtuCallback* ptuCallback; 00107 00109 PanTiltUnitSinkSource() : Node(), 00110 publishEvent(false), 00111 movingPan(false), 00112 movingTilt(false), 00113 process(false) 00114 { 00115 00116 lanc = new Lanc; 00117 float initOri[4]={0.0f, 0.0f, 0.0f, 1.0f}; 00118 float initPos[3]={0.0f, 0.0f, 0.0f}; 00119 topOffset.setPosition(initPos); 00120 topOffset.setOrientation(initOri); 00121 ptuLocation.setPosition(initPos); 00122 ptuLocation.setOrientation(initOri); 00123 00124 } 00125 00126 ~PanTiltUnitSinkSource(); 00127 00128 00129 virtual void onEventGenerated( Event& event, Node& generator); 00130 00131 protected: 00132 00133 int frequency, delayEvent, delay; 00134 00135 // flags to indicate whether relativeInput or ptuGoto was changed during processing 00136 bool publishEvent, movingPan, movingTilt, process; 00137 00138 double getTiltAngle(); 00139 00140 double getPanAngle(); 00141 00142 00143 friend class PanTiltUnitModule; 00144 00145 private: 00146 00147 // This Event holds the desired ptu Location (not implemented yet) 00148 Event ptuGoto; 00149 // This Event defines the moving speed of the ptu axis 00150 Event relativeInput; 00151 // This Event holds the top offset 00152 Event topOffset; 00153 // This Event holds the physical ptu location 00154 Event ptuLocation; 00155 00156 portstream_fd COMstream; 00157 00158 double panResolution, tiltResolution; 00159 00160 Lanc* lanc; 00161 00162 std::queue<Event> delayQueue; 00163 }; 00164 00165 } // namespace ot 00166 00167 #endif //USE_PANTILTUNIT 00168 00169 #endif //_PANTILTUNITSINKSOURCE_H
1.4.6