368 lines
8.6 KiB
C++
368 lines
8.6 KiB
C++
|
|
|
|
#include <Python.h>
|
|
#include "KX_VehicleWrapper.h"
|
|
#include "PHY_IPhysicsEnvironment.h"
|
|
#include "PHY_IVehicle.h"
|
|
#include "KX_PyMath.h"
|
|
#include "KX_GameObject.h"
|
|
#include "KX_MotionState.h"
|
|
|
|
#ifdef HAVE_CONFIG_H
|
|
#include <config.h>
|
|
#endif
|
|
|
|
KX_VehicleWrapper::KX_VehicleWrapper(
|
|
PHY_IVehicle* vehicle,
|
|
PHY_IPhysicsEnvironment* physenv,PyTypeObject *T) :
|
|
PyObjectPlus(T),
|
|
m_vehicle(vehicle),
|
|
m_physenv(physenv)
|
|
{
|
|
}
|
|
|
|
KX_VehicleWrapper::~KX_VehicleWrapper()
|
|
{
|
|
int numMotion = m_motionStates.size();
|
|
for (int i=0;i<numMotion;i++)
|
|
{
|
|
PHY_IMotionState* motionState = m_motionStates[i];
|
|
delete motionState;
|
|
}
|
|
m_motionStates.clear();
|
|
}
|
|
|
|
|
|
PyObject* KX_VehicleWrapper::PyAddWheel(PyObject* self,
|
|
PyObject* args,
|
|
PyObject* kwds)
|
|
{
|
|
|
|
PyObject* pylistPos,*pylistDir,*pylistAxleDir;
|
|
PyObject* wheelGameObject;
|
|
float suspensionRestLength,wheelRadius;
|
|
int hasSteering;
|
|
|
|
|
|
if (PyArg_ParseTuple(args,"OOOOffi",&wheelGameObject,&pylistPos,&pylistDir,&pylistAxleDir,&suspensionRestLength,&wheelRadius,&hasSteering))
|
|
{
|
|
KX_GameObject* gameOb = (KX_GameObject*) wheelGameObject;
|
|
|
|
PHY_IMotionState* motionState = new KX_MotionState(gameOb->GetSGNode());
|
|
|
|
MT_Vector3 attachPos,attachDir,attachAxle;
|
|
PyVecTo(pylistPos,attachPos);
|
|
PyVecTo(pylistDir,attachDir);
|
|
PyVecTo(pylistAxleDir,attachAxle);
|
|
PHY__Vector3 aPos,aDir,aAxle;
|
|
aPos[0] = attachPos[0];
|
|
aPos[1] = attachPos[1];
|
|
aPos[2] = attachPos[2];
|
|
aDir[0] = attachDir[0];
|
|
aDir[1] = attachDir[1];
|
|
aDir[2] = attachDir[2];
|
|
aAxle[0] = -attachAxle[0];//someone reverse some conventions inside Bullet (axle winding)
|
|
aAxle[1] = -attachAxle[1];
|
|
aAxle[2] = -attachAxle[2];
|
|
|
|
printf("attempt for addWheel: suspensionRestLength%f wheelRadius %f, hasSteering:%d\n",suspensionRestLength,wheelRadius,hasSteering);
|
|
m_vehicle->AddWheel(motionState,aPos,aDir,aAxle,suspensionRestLength,wheelRadius,hasSteering);
|
|
|
|
}
|
|
Py_INCREF(Py_None);
|
|
return Py_None;
|
|
}
|
|
|
|
|
|
|
|
|
|
PyObject* KX_VehicleWrapper::PyGetWheelPosition(PyObject* self,
|
|
PyObject* args,
|
|
PyObject* kwds)
|
|
{
|
|
|
|
int wheelIndex;
|
|
|
|
if (PyArg_ParseTuple(args,"i",&wheelIndex))
|
|
{
|
|
float position[3];
|
|
m_vehicle->GetWheelPosition(wheelIndex,position[0],position[1],position[2]);
|
|
MT_Vector3 pos(position[0],position[1],position[2]);
|
|
return PyObjectFrom(pos);
|
|
}
|
|
Py_INCREF(Py_None);
|
|
return Py_None;
|
|
}
|
|
|
|
PyObject* KX_VehicleWrapper::PyGetWheelRotation(PyObject* self,
|
|
PyObject* args,
|
|
PyObject* kwds)
|
|
{
|
|
int wheelIndex;
|
|
if (PyArg_ParseTuple(args,"i",&wheelIndex))
|
|
{
|
|
return PyFloat_FromDouble(m_vehicle->GetWheelRotation(wheelIndex));
|
|
}
|
|
Py_INCREF(Py_None);
|
|
return Py_None;
|
|
}
|
|
|
|
PyObject* KX_VehicleWrapper::PyGetWheelOrientationQuaternion(PyObject* self,
|
|
PyObject* args,
|
|
PyObject* kwds)
|
|
{
|
|
int wheelIndex;
|
|
if (PyArg_ParseTuple(args,"i",&wheelIndex))
|
|
{
|
|
float orn[4];
|
|
m_vehicle->GetWheelOrientationQuaternion(wheelIndex,orn[0],orn[1],orn[2],orn[3]);
|
|
MT_Quaternion quatorn(orn[0],orn[1],orn[2],orn[3]);
|
|
MT_Matrix3x3 ornmat(quatorn);
|
|
return PyObjectFrom(ornmat);
|
|
}
|
|
Py_INCREF(Py_None);
|
|
return Py_None;
|
|
|
|
}
|
|
|
|
|
|
PyObject* KX_VehicleWrapper::PyGetNumWheels(PyObject* self,
|
|
PyObject* args,
|
|
PyObject* kwds)
|
|
{
|
|
return PyInt_FromLong(m_vehicle->GetNumWheels());
|
|
}
|
|
|
|
|
|
PyObject* KX_VehicleWrapper::PyGetConstraintId(PyObject* self,
|
|
PyObject* args,
|
|
PyObject* kwds)
|
|
{
|
|
return PyInt_FromLong(m_vehicle->GetUserConstraintId());
|
|
}
|
|
|
|
|
|
|
|
PyObject* KX_VehicleWrapper::PyApplyEngineForce(PyObject* self,
|
|
PyObject* args,
|
|
PyObject* kwds)
|
|
{
|
|
float force;
|
|
int wheelIndex;
|
|
|
|
if (PyArg_ParseTuple(args,"fi",&force,&wheelIndex))
|
|
{
|
|
force *= -1.f;//someone reverse some conventions inside Bullet (axle winding)
|
|
m_vehicle->ApplyEngineForce(force,wheelIndex);
|
|
}
|
|
Py_INCREF(Py_None);
|
|
return Py_None;
|
|
}
|
|
|
|
PyObject* KX_VehicleWrapper::PySetTyreFriction(PyObject* self,
|
|
PyObject* args,
|
|
PyObject* kwds)
|
|
{
|
|
float wheelFriction;
|
|
int wheelIndex;
|
|
|
|
if (PyArg_ParseTuple(args,"fi",&wheelFriction,&wheelIndex))
|
|
{
|
|
m_vehicle->SetWheelFriction(wheelFriction,wheelIndex);
|
|
}
|
|
Py_INCREF(Py_None);
|
|
return Py_None;
|
|
}
|
|
|
|
PyObject* KX_VehicleWrapper::PySetSuspensionStiffness(PyObject* self,
|
|
PyObject* args,
|
|
PyObject* kwds)
|
|
{
|
|
float suspensionStiffness;
|
|
int wheelIndex;
|
|
|
|
if (PyArg_ParseTuple(args,"fi",&suspensionStiffness,&wheelIndex))
|
|
{
|
|
m_vehicle->SetSuspensionStiffness(suspensionStiffness,wheelIndex);
|
|
}
|
|
Py_INCREF(Py_None);
|
|
return Py_None;
|
|
}
|
|
|
|
PyObject* KX_VehicleWrapper::PySetSuspensionDamping(PyObject* self,
|
|
PyObject* args,
|
|
PyObject* kwds)
|
|
{
|
|
float suspensionDamping;
|
|
int wheelIndex;
|
|
|
|
if (PyArg_ParseTuple(args,"fi",&suspensionDamping,&wheelIndex))
|
|
{
|
|
m_vehicle->SetSuspensionDamping(suspensionDamping,wheelIndex);
|
|
}
|
|
Py_INCREF(Py_None);
|
|
return Py_None;
|
|
}
|
|
|
|
PyObject* KX_VehicleWrapper::PySetSuspensionCompression(PyObject* self,
|
|
PyObject* args,
|
|
PyObject* kwds)
|
|
{
|
|
float suspensionCompression;
|
|
int wheelIndex;
|
|
|
|
if (PyArg_ParseTuple(args,"fi",&suspensionCompression,&wheelIndex))
|
|
{
|
|
m_vehicle->SetSuspensionCompression(suspensionCompression,wheelIndex);
|
|
}
|
|
Py_INCREF(Py_None);
|
|
return Py_None;
|
|
}
|
|
|
|
PyObject* KX_VehicleWrapper::PySetRollInfluence(PyObject* self,
|
|
PyObject* args,
|
|
PyObject* kwds)
|
|
{
|
|
float rollInfluence;
|
|
int wheelIndex;
|
|
|
|
if (PyArg_ParseTuple(args,"fi",&rollInfluence,&wheelIndex))
|
|
{
|
|
m_vehicle->SetRollInfluence(rollInfluence,wheelIndex);
|
|
}
|
|
Py_INCREF(Py_None);
|
|
return Py_None;
|
|
}
|
|
|
|
|
|
PyObject* KX_VehicleWrapper::PyApplyBraking(PyObject* self,
|
|
PyObject* args,
|
|
PyObject* kwds)
|
|
{
|
|
float braking;
|
|
int wheelIndex;
|
|
|
|
if (PyArg_ParseTuple(args,"fi",&braking,&wheelIndex))
|
|
{
|
|
m_vehicle->ApplyBraking(braking,wheelIndex);
|
|
}
|
|
Py_INCREF(Py_None);
|
|
return Py_None;
|
|
}
|
|
|
|
|
|
|
|
|
|
PyObject* KX_VehicleWrapper::PySetSteeringValue(PyObject* self,
|
|
PyObject* args,
|
|
PyObject* kwds)
|
|
{
|
|
float steeringValue;
|
|
int wheelIndex;
|
|
|
|
if (PyArg_ParseTuple(args,"fi",&steeringValue,&wheelIndex))
|
|
{
|
|
m_vehicle->SetSteeringValue(steeringValue,wheelIndex);
|
|
}
|
|
Py_INCREF(Py_None);
|
|
return Py_None;
|
|
}
|
|
|
|
|
|
PyObject* KX_VehicleWrapper::PyGetConstraintType(PyObject* self,
|
|
PyObject* args,
|
|
PyObject* kwds)
|
|
{
|
|
return PyInt_FromLong(m_vehicle->GetUserConstraintType());
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
//python specific stuff
|
|
PyTypeObject KX_VehicleWrapper::Type = {
|
|
PyObject_HEAD_INIT(&PyType_Type)
|
|
0,
|
|
"KX_VehicleWrapper",
|
|
sizeof(KX_VehicleWrapper),
|
|
0,
|
|
PyDestructor,
|
|
0,
|
|
__getattr,
|
|
__setattr,
|
|
0, //&MyPyCompare,
|
|
__repr,
|
|
0, //&cvalue_as_number,
|
|
0,
|
|
0,
|
|
0,
|
|
0
|
|
};
|
|
|
|
PyParentObject KX_VehicleWrapper::Parents[] = {
|
|
&KX_VehicleWrapper::Type,
|
|
NULL
|
|
};
|
|
|
|
PyObject* KX_VehicleWrapper::_getattr(const STR_String& attr)
|
|
{
|
|
//here you can search for existing data members (like mass,friction etc.)
|
|
_getattr_up(PyObjectPlus);
|
|
}
|
|
|
|
int KX_VehicleWrapper::_setattr(const STR_String& attr,PyObject* pyobj)
|
|
{
|
|
|
|
PyTypeObject* type = pyobj->ob_type;
|
|
int result = 1;
|
|
|
|
if (type == &PyList_Type)
|
|
{
|
|
result = 0;
|
|
}
|
|
if (type == &PyFloat_Type)
|
|
{
|
|
result = 0;
|
|
|
|
}
|
|
if (type == &PyInt_Type)
|
|
{
|
|
result = 0;
|
|
}
|
|
if (type == &PyString_Type)
|
|
{
|
|
result = 0;
|
|
}
|
|
if (result)
|
|
result = PyObjectPlus::_setattr(attr,pyobj);
|
|
return result;
|
|
};
|
|
|
|
|
|
PyMethodDef KX_VehicleWrapper::Methods[] = {
|
|
{"addWheel",(PyCFunction) KX_VehicleWrapper::sPyAddWheel, METH_VARARGS},
|
|
{"getNumWheels",(PyCFunction) KX_VehicleWrapper::sPyGetNumWheels, METH_VARARGS},
|
|
{"getWheelOrientationQuaternion",(PyCFunction) KX_VehicleWrapper::sPyGetWheelOrientationQuaternion, METH_VARARGS},
|
|
{"getWheelRotation",(PyCFunction) KX_VehicleWrapper::sPyGetWheelRotation, METH_VARARGS},
|
|
{"getWheelPosition",(PyCFunction) KX_VehicleWrapper::sPyGetWheelPosition, METH_VARARGS},
|
|
{"getConstraintId",(PyCFunction) KX_VehicleWrapper::sPyGetConstraintId, METH_VARARGS},
|
|
{"getConstraintType",(PyCFunction) KX_VehicleWrapper::sPyGetConstraintType, METH_VARARGS},
|
|
{"setSteeringValue",(PyCFunction) KX_VehicleWrapper::sPySetSteeringValue, METH_VARARGS},
|
|
{"applyEngineForce",(PyCFunction) KX_VehicleWrapper::sPyApplyEngineForce, METH_VARARGS},
|
|
{"applyBraking",(PyCFunction) KX_VehicleWrapper::sPyApplyBraking, METH_VARARGS},
|
|
|
|
{"setTyreFriction",(PyCFunction) KX_VehicleWrapper::sPySetTyreFriction, METH_VARARGS},
|
|
|
|
{"setSuspensionStiffness",(PyCFunction) KX_VehicleWrapper::sPySetSuspensionStiffness, METH_VARARGS},
|
|
|
|
{"setSuspensionDamping",(PyCFunction) KX_VehicleWrapper::sPySetSuspensionDamping, METH_VARARGS},
|
|
|
|
{"setSuspensionCompression",(PyCFunction) KX_VehicleWrapper::sPySetSuspensionCompression, METH_VARARGS},
|
|
|
|
{"setRollInfluence",(PyCFunction) KX_VehicleWrapper::sPySetRollInfluence, METH_VARARGS},
|
|
|
|
{NULL,NULL} //Sentinel
|
|
};
|
|
|