|
|
@@ -0,0 +1,91 @@
|
|
|
+// Filename: cConstrainPosHprInterval.cxx
|
|
|
+// Created by: pratt (10Mar08)
|
|
|
+//
|
|
|
+////////////////////////////////////////////////////////////////////
|
|
|
+//
|
|
|
+// PANDA 3D SOFTWARE
|
|
|
+// Copyright (c) 2001 - 2008, Disney Enterprises, Inc. All rights reserved
|
|
|
+//
|
|
|
+// All use of this software is subject to the terms of the Panda 3d
|
|
|
+// Software license. You should have received a copy of this license
|
|
|
+// along with this source code; you will also find a current copy of
|
|
|
+// the license at http://etc.cmu.edu/panda3d/docs/license/ .
|
|
|
+//
|
|
|
+// To contact the maintainers of this program write to
|
|
|
+// [email protected] .
|
|
|
+//
|
|
|
+////////////////////////////////////////////////////////////////////
|
|
|
+
|
|
|
+#include "cConstrainPosHprInterval.h"
|
|
|
+#include "config_interval.h"
|
|
|
+#include "lvecBase3.h"
|
|
|
+
|
|
|
+TypeHandle CConstrainPosHprInterval::_type_handle;
|
|
|
+
|
|
|
+////////////////////////////////////////////////////////////////////
|
|
|
+// Function: CConstrainPosHprInterval::Constructor
|
|
|
+// Access: Published
|
|
|
+// Description: Constructs a constraint interval that will constrain
|
|
|
+// the position and orientation of one node to the
|
|
|
+// position and orientation of another.
|
|
|
+//
|
|
|
+// If wrt is true, the node's position and orientation
|
|
|
+// will be transformed into the target node's parent's
|
|
|
+// space before being copied. If wrt is false, the
|
|
|
+// target node's local position and orientation will be
|
|
|
+// copied unaltered.
|
|
|
+////////////////////////////////////////////////////////////////////
|
|
|
+CConstrainPosHprInterval::
|
|
|
+CConstrainPosHprInterval(const string &name, double duration,
|
|
|
+ const NodePath &node, const NodePath &target,
|
|
|
+ bool wrt, const LVecBase3f posOffset,
|
|
|
+ const LVecBase3f hprOffset) :
|
|
|
+ CConstraintInterval(name, duration),
|
|
|
+ _node(node),
|
|
|
+ _target(target),
|
|
|
+ _wrt(wrt),
|
|
|
+ _posOffset(posOffset)
|
|
|
+{
|
|
|
+ _quatOffset.set_hpr(hprOffset);
|
|
|
+}
|
|
|
+
|
|
|
+////////////////////////////////////////////////////////////////////
|
|
|
+// Function: CConstrainPosHprInterval::step
|
|
|
+// Access: Published, Virtual
|
|
|
+// Description: Advances the time on the interval. The time may
|
|
|
+// either increase (the normal case) or decrease
|
|
|
+// (e.g. if the interval is being played by a slider).
|
|
|
+////////////////////////////////////////////////////////////////////
|
|
|
+void CConstrainPosHprInterval::
|
|
|
+priv_step(double t) {
|
|
|
+ check_started(get_class_type(), "priv_step");
|
|
|
+ _state = S_started;
|
|
|
+ _curr_t = t;
|
|
|
+
|
|
|
+ if(! _target.is_empty()) {
|
|
|
+ if(_wrt) {
|
|
|
+ if(! _node.is_same_graph(_target)){
|
|
|
+ interval_cat.warning()
|
|
|
+ << "Unable to copy position and orientation in CConstrainPosHprInterval::priv_step;\n"
|
|
|
+ << "node (" << _node.get_name()
|
|
|
+ << ") and target (" << _target.get_name()
|
|
|
+ << ") are not in the same graph.\n";
|
|
|
+ return;
|
|
|
+ }
|
|
|
+ _target.set_pos_quat(_node, _posOffset, _quatOffset);
|
|
|
+ } else {
|
|
|
+ _target.set_pos_quat(_node.get_pos() + _posOffset, _quatOffset*_node.get_quat());
|
|
|
+ }
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+////////////////////////////////////////////////////////////////////
|
|
|
+// Function: CConstrainPosHprInterval::output
|
|
|
+// Access: Published, Virtual
|
|
|
+// Description:
|
|
|
+////////////////////////////////////////////////////////////////////
|
|
|
+void CConstrainPosHprInterval::
|
|
|
+output(ostream &out) const {
|
|
|
+ out << get_name() << ":";
|
|
|
+ out << " dur " << get_duration();
|
|
|
+}
|