5398f1ba77
Fixed drot actuator. The rotation matrix was being mutilated by passing a float[9] instead of float[12].
401 lines
12 KiB
C++
401 lines
12 KiB
C++
/**
|
|
* Do translation/rotation actions
|
|
*
|
|
* $Id$
|
|
*
|
|
* ***** BEGIN GPL/BL DUAL LICENSE BLOCK *****
|
|
*
|
|
* This program is free software; you can redistribute it and/or
|
|
* modify it under the terms of the GNU General Public License
|
|
* as published by the Free Software Foundation; either version 2
|
|
* of the License, or (at your option) any later version. The Blender
|
|
* Foundation also sells licenses for use in proprietary software under
|
|
* the Blender License. See http://www.blender.org/BL/ for information
|
|
* about this.
|
|
*
|
|
* This program is distributed in the hope that it will be useful,
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
* GNU General Public License for more details.
|
|
*
|
|
* You should have received a copy of the GNU General Public License
|
|
* along with this program; if not, write to the Free Software Foundation,
|
|
* Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
|
|
*
|
|
* The Original Code is Copyright (C) 2001-2002 by NaN Holding BV.
|
|
* All rights reserved.
|
|
*
|
|
* The Original Code is: all of this file.
|
|
*
|
|
* Contributor(s): none yet.
|
|
*
|
|
* ***** END GPL/BL DUAL LICENSE BLOCK *****
|
|
*/
|
|
|
|
#include "KX_ObjectActuator.h"
|
|
#include "KX_GameObject.h"
|
|
#include "KX_IPhysicsController.h"
|
|
|
|
#ifdef HAVE_CONFIG_H
|
|
#include <config.h>
|
|
#endif
|
|
|
|
/* ------------------------------------------------------------------------- */
|
|
/* Native functions */
|
|
/* ------------------------------------------------------------------------- */
|
|
|
|
KX_ObjectActuator::
|
|
KX_ObjectActuator(
|
|
SCA_IObject* gameobj,
|
|
const MT_Vector3& force,
|
|
const MT_Vector3& torque,
|
|
const MT_Vector3& dloc,
|
|
const MT_Vector3& drot,
|
|
const MT_Vector3& linV,
|
|
const MT_Vector3& angV,
|
|
const KX_LocalFlags& flag,
|
|
PyTypeObject* T
|
|
) :
|
|
SCA_IActuator(gameobj,T),
|
|
m_force(force),
|
|
m_torque(torque),
|
|
m_dloc(dloc),
|
|
m_drot(drot),
|
|
m_linear_velocity(linV),
|
|
m_angular_velocity(angV),
|
|
m_bitLocalFlag (flag),
|
|
m_active_combined_velocity (false)
|
|
{
|
|
}
|
|
|
|
bool KX_ObjectActuator::Update(double curtime,double deltatime)
|
|
{
|
|
|
|
bool bNegativeEvent = IsNegativeEvent();
|
|
RemoveAllEvents();
|
|
|
|
KX_GameObject *parent = static_cast<KX_GameObject *>(GetParent());
|
|
|
|
if (bNegativeEvent) {
|
|
// If we previously set the linear velocity we now have to inform
|
|
// the physics controller that we no longer wish to apply it and that
|
|
// it should reconcile the externally set velocity with it's
|
|
// own velocity.
|
|
if (m_active_combined_velocity) {
|
|
parent->ResolveCombinedVelocities(
|
|
m_linear_velocity,
|
|
m_angular_velocity,
|
|
(m_bitLocalFlag.LinearVelocity) != 0,
|
|
(m_bitLocalFlag.AngularVelocity) != 0
|
|
);
|
|
m_active_combined_velocity = false;
|
|
return false;
|
|
} else {
|
|
return false;
|
|
}
|
|
|
|
} else
|
|
if (parent)
|
|
{
|
|
/* Probably better to use some flags, so these MT_zero tests can be */
|
|
/* skipped. */
|
|
if (!MT_fuzzyZero(m_force))
|
|
{
|
|
parent->ApplyForce(m_force,(m_bitLocalFlag.Force) != 0);
|
|
}
|
|
if (!MT_fuzzyZero(m_torque))
|
|
{
|
|
parent->ApplyTorque(m_torque,(m_bitLocalFlag.Torque) != 0);
|
|
}
|
|
if (!MT_fuzzyZero(m_dloc))
|
|
{
|
|
parent->ApplyMovement(m_dloc,(m_bitLocalFlag.DLoc) != 0);
|
|
}
|
|
if (!MT_fuzzyZero(m_drot))
|
|
{
|
|
parent->ApplyRotation(m_drot,(m_bitLocalFlag.DRot) != 0);
|
|
}
|
|
if (!MT_fuzzyZero(m_linear_velocity))
|
|
{
|
|
if (m_bitLocalFlag.AddOrSetLinV) {
|
|
parent->addLinearVelocity(m_linear_velocity,(m_bitLocalFlag.LinearVelocity) != 0);
|
|
} else {
|
|
m_active_combined_velocity = true;
|
|
parent->setLinearVelocity(m_linear_velocity,(m_bitLocalFlag.LinearVelocity) != 0);
|
|
}
|
|
}
|
|
if (!MT_fuzzyZero(m_angular_velocity))
|
|
{
|
|
parent->setAngularVelocity(m_angular_velocity,(m_bitLocalFlag.AngularVelocity) != 0);
|
|
m_active_combined_velocity = true;
|
|
}
|
|
|
|
}
|
|
return true;
|
|
}
|
|
|
|
|
|
|
|
CValue* KX_ObjectActuator::GetReplica()
|
|
{
|
|
KX_ObjectActuator* replica = new KX_ObjectActuator(*this);//m_float,GetName());
|
|
replica->ProcessReplica();
|
|
|
|
// this will copy properties and so on...
|
|
CValue::AddDataToReplica(replica);
|
|
|
|
return replica;
|
|
}
|
|
|
|
|
|
|
|
/* some 'standard' utilities... */
|
|
bool KX_ObjectActuator::isValid(KX_ObjectActuator::KX_OBJECT_ACT_VEC_TYPE type)
|
|
{
|
|
bool res = false;
|
|
res = (type > KX_OBJECT_ACT_NODEF) && (type < KX_OBJECT_ACT_MAX);
|
|
return res;
|
|
}
|
|
|
|
|
|
|
|
/* ------------------------------------------------------------------------- */
|
|
/* Python functions */
|
|
/* ------------------------------------------------------------------------- */
|
|
|
|
/* Integration hooks ------------------------------------------------------- */
|
|
PyTypeObject KX_ObjectActuator::Type = {
|
|
PyObject_HEAD_INIT(&PyType_Type)
|
|
0,
|
|
"KX_ObjectActuator",
|
|
sizeof(KX_ObjectActuator),
|
|
0,
|
|
PyDestructor,
|
|
0,
|
|
__getattr,
|
|
__setattr,
|
|
0, //&MyPyCompare,
|
|
__repr,
|
|
0, //&cvalue_as_number,
|
|
0,
|
|
0,
|
|
0,
|
|
0
|
|
};
|
|
|
|
PyParentObject KX_ObjectActuator::Parents[] = {
|
|
&KX_ObjectActuator::Type,
|
|
&SCA_IActuator::Type,
|
|
&SCA_ILogicBrick::Type,
|
|
&CValue::Type,
|
|
NULL
|
|
};
|
|
|
|
PyMethodDef KX_ObjectActuator::Methods[] = {
|
|
{"getForce", (PyCFunction) KX_ObjectActuator::sPyGetForce, METH_VARARGS},
|
|
{"setForce", (PyCFunction) KX_ObjectActuator::sPySetForce, METH_VARARGS},
|
|
{"getTorque", (PyCFunction) KX_ObjectActuator::sPyGetTorque, METH_VARARGS},
|
|
{"setTorque", (PyCFunction) KX_ObjectActuator::sPySetTorque, METH_VARARGS},
|
|
{"getDLoc", (PyCFunction) KX_ObjectActuator::sPyGetDLoc, METH_VARARGS},
|
|
{"setDLoc", (PyCFunction) KX_ObjectActuator::sPySetDLoc, METH_VARARGS},
|
|
{"getDRot", (PyCFunction) KX_ObjectActuator::sPyGetDRot, METH_VARARGS},
|
|
{"setDRot", (PyCFunction) KX_ObjectActuator::sPySetDRot, METH_VARARGS},
|
|
{"getLinearVelocity", (PyCFunction) KX_ObjectActuator::sPyGetLinearVelocity, METH_VARARGS},
|
|
{"setLinearVelocity", (PyCFunction) KX_ObjectActuator::sPySetLinearVelocity, METH_VARARGS},
|
|
{"getAngularVelocity", (PyCFunction) KX_ObjectActuator::sPyGetAngularVelocity, METH_VARARGS},
|
|
{"setAngularVelocity", (PyCFunction) KX_ObjectActuator::sPySetAngularVelocity, METH_VARARGS},
|
|
|
|
|
|
{NULL,NULL} //Sentinel
|
|
};
|
|
|
|
PyObject* KX_ObjectActuator::_getattr(char* attr) {
|
|
_getattr_up(SCA_IActuator);
|
|
};
|
|
|
|
/* 1. set ------------------------------------------------------------------ */
|
|
/* Removed! */
|
|
|
|
/* 2. getForce */
|
|
PyObject* KX_ObjectActuator::PyGetForce(PyObject* self,
|
|
PyObject* args,
|
|
PyObject* kwds)
|
|
{
|
|
PyObject *retVal = PyList_New(4);
|
|
|
|
PyList_SetItem(retVal, 0, PyFloat_FromDouble(m_force[0]));
|
|
PyList_SetItem(retVal, 1, PyFloat_FromDouble(m_force[1]));
|
|
PyList_SetItem(retVal, 2, PyFloat_FromDouble(m_force[2]));
|
|
PyList_SetItem(retVal, 3, BoolToPyArg(m_bitLocalFlag.Force));
|
|
|
|
return retVal;
|
|
}
|
|
/* 3. setForce */
|
|
PyObject* KX_ObjectActuator::PySetForce(PyObject* self,
|
|
PyObject* args,
|
|
PyObject* kwds)
|
|
{
|
|
float vecArg[3];
|
|
int bToggle = 0;
|
|
if (!PyArg_ParseTuple(args, "fffi", &vecArg[0], &vecArg[1],
|
|
&vecArg[2], &bToggle)) {
|
|
return NULL;
|
|
}
|
|
m_force.setValue(vecArg);
|
|
m_bitLocalFlag.Force = PyArgToBool(bToggle);
|
|
Py_Return;
|
|
}
|
|
|
|
/* 4. getTorque */
|
|
PyObject* KX_ObjectActuator::PyGetTorque(PyObject* self,
|
|
PyObject* args,
|
|
PyObject* kwds)
|
|
{
|
|
PyObject *retVal = PyList_New(4);
|
|
|
|
PyList_SetItem(retVal, 0, PyFloat_FromDouble(m_torque[0]));
|
|
PyList_SetItem(retVal, 1, PyFloat_FromDouble(m_torque[1]));
|
|
PyList_SetItem(retVal, 2, PyFloat_FromDouble(m_torque[2]));
|
|
PyList_SetItem(retVal, 3, BoolToPyArg(m_bitLocalFlag.Torque));
|
|
|
|
return retVal;
|
|
}
|
|
/* 5. setTorque */
|
|
PyObject* KX_ObjectActuator::PySetTorque(PyObject* self,
|
|
PyObject* args,
|
|
PyObject* kwds)
|
|
{
|
|
float vecArg[3];
|
|
int bToggle = 0;
|
|
if (!PyArg_ParseTuple(args, "fffi", &vecArg[0], &vecArg[1],
|
|
&vecArg[2], &bToggle)) {
|
|
return NULL;
|
|
}
|
|
m_torque.setValue(vecArg);
|
|
m_bitLocalFlag.Torque = PyArgToBool(bToggle);
|
|
Py_Return;
|
|
}
|
|
|
|
/* 6. getDLoc */
|
|
PyObject* KX_ObjectActuator::PyGetDLoc(PyObject* self,
|
|
PyObject* args,
|
|
PyObject* kwds)
|
|
{
|
|
PyObject *retVal = PyList_New(4);
|
|
|
|
PyList_SetItem(retVal, 0, PyFloat_FromDouble(m_dloc[0]));
|
|
PyList_SetItem(retVal, 1, PyFloat_FromDouble(m_dloc[1]));
|
|
PyList_SetItem(retVal, 2, PyFloat_FromDouble(m_dloc[2]));
|
|
PyList_SetItem(retVal, 3, BoolToPyArg(m_bitLocalFlag.DLoc));
|
|
|
|
return retVal;
|
|
}
|
|
/* 7. setDLoc */
|
|
PyObject* KX_ObjectActuator::PySetDLoc(PyObject* self,
|
|
PyObject* args,
|
|
PyObject* kwds)
|
|
{
|
|
float vecArg[3];
|
|
int bToggle = 0;
|
|
if(!PyArg_ParseTuple(args, "fffi", &vecArg[0], &vecArg[1],
|
|
&vecArg[2], &bToggle)) {
|
|
return NULL;
|
|
}
|
|
m_dloc.setValue(vecArg);
|
|
m_bitLocalFlag.DLoc = PyArgToBool(bToggle);
|
|
Py_Return;
|
|
}
|
|
|
|
/* 8. getDRot */
|
|
PyObject* KX_ObjectActuator::PyGetDRot(PyObject* self,
|
|
PyObject* args,
|
|
PyObject* kwds)
|
|
{
|
|
PyObject *retVal = PyList_New(4);
|
|
|
|
PyList_SetItem(retVal, 0, PyFloat_FromDouble(m_drot[0]));
|
|
PyList_SetItem(retVal, 1, PyFloat_FromDouble(m_drot[1]));
|
|
PyList_SetItem(retVal, 2, PyFloat_FromDouble(m_drot[2]));
|
|
PyList_SetItem(retVal, 3, BoolToPyArg(m_bitLocalFlag.DRot));
|
|
|
|
return retVal;
|
|
}
|
|
/* 9. setDRot */
|
|
PyObject* KX_ObjectActuator::PySetDRot(PyObject* self,
|
|
PyObject* args,
|
|
PyObject* kwds)
|
|
{
|
|
float vecArg[3];
|
|
int bToggle = 0;
|
|
if (!PyArg_ParseTuple(args, "fffi", &vecArg[0], &vecArg[1],
|
|
&vecArg[2], &bToggle)) {
|
|
return NULL;
|
|
}
|
|
m_drot.setValue(vecArg);
|
|
m_bitLocalFlag.DRot = PyArgToBool(bToggle);
|
|
Py_Return;
|
|
}
|
|
|
|
/* 10. getLinearVelocity */
|
|
PyObject* KX_ObjectActuator::PyGetLinearVelocity(PyObject* self,
|
|
PyObject* args,
|
|
PyObject* kwds) {
|
|
PyObject *retVal = PyList_New(4);
|
|
|
|
PyList_SetItem(retVal, 0, PyFloat_FromDouble(m_linear_velocity[0]));
|
|
PyList_SetItem(retVal, 1, PyFloat_FromDouble(m_linear_velocity[1]));
|
|
PyList_SetItem(retVal, 2, PyFloat_FromDouble(m_linear_velocity[2]));
|
|
PyList_SetItem(retVal, 3, BoolToPyArg(m_bitLocalFlag.LinearVelocity));
|
|
|
|
return retVal;
|
|
}
|
|
|
|
/* 11. setLinearVelocity */
|
|
PyObject* KX_ObjectActuator::PySetLinearVelocity(PyObject* self,
|
|
PyObject* args,
|
|
PyObject* kwds) {
|
|
float vecArg[3];
|
|
int bToggle = 0;
|
|
if (!PyArg_ParseTuple(args, "fffi", &vecArg[0], &vecArg[1],
|
|
&vecArg[2], &bToggle)) {
|
|
return NULL;
|
|
}
|
|
m_linear_velocity.setValue(vecArg);
|
|
m_bitLocalFlag.LinearVelocity = PyArgToBool(bToggle);
|
|
Py_Return;
|
|
}
|
|
|
|
|
|
/* 12. getAngularVelocity */
|
|
PyObject* KX_ObjectActuator::PyGetAngularVelocity(PyObject* self,
|
|
PyObject* args,
|
|
PyObject* kwds) {
|
|
PyObject *retVal = PyList_New(4);
|
|
|
|
PyList_SetItem(retVal, 0, PyFloat_FromDouble(m_angular_velocity[0]));
|
|
PyList_SetItem(retVal, 1, PyFloat_FromDouble(m_angular_velocity[1]));
|
|
PyList_SetItem(retVal, 2, PyFloat_FromDouble(m_angular_velocity[2]));
|
|
PyList_SetItem(retVal, 3, BoolToPyArg(m_bitLocalFlag.AngularVelocity));
|
|
|
|
return retVal;
|
|
}
|
|
/* 13. setAngularVelocity */
|
|
PyObject* KX_ObjectActuator::PySetAngularVelocity(PyObject* self,
|
|
PyObject* args,
|
|
PyObject* kwds) {
|
|
float vecArg[3];
|
|
int bToggle = 0;
|
|
if (!PyArg_ParseTuple(args, "fffi", &vecArg[0], &vecArg[1],
|
|
&vecArg[2], &bToggle)) {
|
|
return NULL;
|
|
}
|
|
m_angular_velocity.setValue(vecArg);
|
|
m_bitLocalFlag.AngularVelocity = PyArgToBool(bToggle);
|
|
Py_Return;
|
|
}
|
|
|
|
|
|
|
|
|
|
/* eof */
|