svn merge -r 15292:15392 https://svn.blender.org/svnroot/bf-blender/trunk/blender
[blender.git] / source / gameengine / Ketsji / KX_RadarSensor.cpp
1 /**
2  * $Id$
3  * ***** BEGIN GPL LICENSE BLOCK *****
4  *
5  * This program is free software; you can redistribute it and/or
6  * modify it under the terms of the GNU General Public License
7  * as published by the Free Software Foundation; either version 2
8  * of the License, or (at your option) any later version.
9  *
10  * This program is distributed in the hope that it will be useful,
11  * but WITHOUT ANY WARRANTY; without even the implied warranty of
12  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
13  * GNU General Public License for more details.
14  *
15  * You should have received a copy of the GNU General Public License
16  * along with this program; if not, write to the Free Software Foundation,
17  * Inc., 59 Temple Place - Suite 330, Boston, MA  02111-1307, USA.
18  *
19  * The Original Code is Copyright (C) 2001-2002 by NaN Holding BV.
20  * All rights reserved.
21  *
22  * The Original Code is: all of this file.
23  *
24  * Contributor(s): none yet.
25  *
26  * ***** END GPL LICENSE BLOCK *****
27  */
28
29 #include "KX_RadarSensor.h"
30 #include "KX_GameObject.h"
31 #include "PHY_IPhysicsController.h"
32
33 #ifdef HAVE_CONFIG_H
34 #include <config.h>
35 #endif
36
37 /**
38  *      RadarSensor constructor. Creates a near-sensor derived class, with a cone collision shape.
39  */
40 KX_RadarSensor::KX_RadarSensor(SCA_EventManager* eventmgr,
41                 KX_GameObject* gameobj,
42                 PHY_IPhysicsController* physCtrl,
43                         double coneradius,
44                         double coneheight,
45                         int     axis,
46                         double margin,
47                         double resetmargin,
48                         bool bFindMaterial,
49                         const STR_String& touchedpropname,
50                         class KX_Scene* kxscene,
51                         PyTypeObject* T)
52
53                         : KX_NearSensor(
54                                 eventmgr,
55                                 gameobj,
56                                 //DT_NewCone(coneradius,coneheight),
57                                 margin,
58                                 resetmargin,
59                                 bFindMaterial,
60                                 touchedpropname,
61                                 kxscene,
62                                 physCtrl,
63                                 T),
64                                 m_coneradius(coneradius),
65                                 m_coneheight(coneheight),
66                                 m_axis(axis)
67 {
68         m_client_info->m_type = KX_ClientObjectInfo::RADAR;
69         //m_client_info->m_clientobject = gameobj;
70         //m_client_info->m_auxilary_info = NULL;
71         //sumoObj->setClientObject(&m_client_info);
72 }
73                         
74 KX_RadarSensor::~KX_RadarSensor()
75 {
76         
77 }
78
79 CValue* KX_RadarSensor::GetReplica()
80 {
81         KX_RadarSensor* replica = new KX_RadarSensor(*this);
82         replica->m_colliders = new CListValue();
83         replica->m_bCollision = false;
84         replica->m_bTriggered= false;
85         replica->m_hitObject = NULL;
86         replica->m_bLastTriggered = false;
87         // this will copy properties and so on...
88         CValue::AddDataToReplica(replica);
89         
90         replica->m_client_info = new KX_ClientObjectInfo(m_client_info->m_gameobject, KX_ClientObjectInfo::RADAR);
91         
92         if (replica->m_physCtrl)
93         {
94                 replica->m_physCtrl = replica->m_physCtrl->GetReplica();
95         }
96
97         //todo: make sure replication works fine!
98         //>m_sumoObj = new SM_Object(DT_NewCone(m_coneradius, m_coneheight),NULL,NULL,NULL);
99         //replica->m_sumoObj->setMargin(m_Margin);
100         //replica->m_sumoObj->setClientObject(replica->m_client_info);
101         
102         ((KX_GameObject*)replica->GetParent())->GetSGNode()->ComputeWorldTransforms(NULL);
103         replica->SynchronizeTransform();
104         
105         return replica;
106 }
107
108
109 /**
110  *      Transforms the collision object. A cone is not correctly centered
111  *      for usage.  */
112 void KX_RadarSensor::SynchronizeTransform()
113 {
114         // Getting the parent location was commented out. Why?
115         MT_Transform trans;
116         trans.setOrigin(((KX_GameObject*)GetParent())->NodeGetWorldPosition());
117         trans.setBasis(((KX_GameObject*)GetParent())->NodeGetWorldOrientation());
118         // What is the default orientation? pointing in the -y direction?
119         // is the geometry correctly converted?
120
121         // a collision cone is oriented
122         // center the cone correctly 
123         // depends on the radar 'axis'
124         switch (m_axis)
125         {
126         case 0: // +X Axis
127                 {
128                         MT_Quaternion rotquatje(MT_Vector3(0,0,1),MT_radians(90));
129                         trans.rotate(rotquatje);
130                         trans.translate(MT_Vector3 (0, -m_coneheight/2.0 ,0));
131                         break;
132                 };
133         case 1: // +Y Axis
134                 {
135                         MT_Quaternion rotquatje(MT_Vector3(1,0,0),MT_radians(-180));
136                         trans.rotate(rotquatje);
137                         trans.translate(MT_Vector3 (0, -m_coneheight/2.0 ,0));
138                         break;
139                 };
140         case 2: // +Z Axis
141                 {
142                         MT_Quaternion rotquatje(MT_Vector3(1,0,0),MT_radians(-90));
143                         trans.rotate(rotquatje);
144                         trans.translate(MT_Vector3 (0, -m_coneheight/2.0 ,0));
145                         break;
146                 };
147         case 3: // -X Axis
148                 {
149                         MT_Quaternion rotquatje(MT_Vector3(0,0,1),MT_radians(90));
150                         trans.rotate(rotquatje);
151                         trans.translate(MT_Vector3 (0, m_coneheight/2.0 ,0));
152                         break;
153                 };
154         case 4: // -Y Axis
155                 {
156                         MT_Quaternion rotquatje(MT_Vector3(1,0,0),MT_radians(-180));
157                         trans.rotate(rotquatje);
158                         trans.translate(MT_Vector3 (0, m_coneheight/2.0 ,0));
159                         break;
160                 };
161         case 5: // -Z Axis
162                 {
163                         MT_Quaternion rotquatje(MT_Vector3(1,0,0),MT_radians(-90));
164                         trans.rotate(rotquatje);
165                         trans.translate(MT_Vector3 (0, m_coneheight/2.0 ,0));
166                         break;
167                 };
168         default:
169                 {
170                 }
171         }
172         m_cone_origin = trans.getOrigin();
173         m_cone_target = trans(MT_Point3(0, -m_coneheight/2.0 ,0));
174
175
176         if (m_physCtrl)
177         {
178                 m_physCtrl->setPosition(trans.getOrigin().x(),trans.getOrigin().y(),trans.getOrigin().z());
179                 m_physCtrl->setOrientation(trans.getRotation().x(),trans.getRotation().y(),trans.getRotation().z(),trans.getRotation().w());
180                 m_physCtrl->calcXform();
181         }
182
183 }
184
185 /* ------------------------------------------------------------------------- */
186 /* Python functions                                                          */
187 /* ------------------------------------------------------------------------- */
188
189 /* Integration hooks ------------------------------------------------------- */
190 PyTypeObject KX_RadarSensor::Type = {
191         PyObject_HEAD_INIT(&PyType_Type)
192         0,
193         "KX_RadarSensor",
194         sizeof(KX_RadarSensor),
195         0,
196         PyDestructor,
197         0,
198         __getattr,
199         __setattr,
200         0, //&MyPyCompare,
201         __repr,
202         0, //&cvalue_as_number,
203         0,
204         0,
205         0,
206         0
207 };
208
209 PyParentObject KX_RadarSensor::Parents[] = {
210         &KX_RadarSensor::Type,
211         &KX_NearSensor::Type,
212         &KX_TouchSensor::Type,
213         &SCA_ISensor::Type,
214         &SCA_ILogicBrick::Type,
215         &CValue::Type,
216         NULL
217 };
218
219 PyMethodDef KX_RadarSensor::Methods[] = {
220         {"getConeOrigin", (PyCFunction) KX_RadarSensor::sPyGetConeOrigin, 
221          METH_VARARGS, GetConeOrigin_doc},
222         {"getConeTarget", (PyCFunction) KX_RadarSensor::sPyGetConeTarget, 
223          METH_VARARGS, GetConeTarget_doc},
224         {"getConeHeight", (PyCFunction) KX_RadarSensor::sPyGetConeHeight, 
225          METH_VARARGS, GetConeHeight_doc},
226         {NULL,NULL,NULL,NULL} //Sentinel
227 };
228
229 PyObject* KX_RadarSensor::_getattr(const STR_String& attr) {
230         _getattr_up(KX_TouchSensor);
231 }
232
233 /* getConeOrigin */
234 char KX_RadarSensor::GetConeOrigin_doc[] = 
235 "getConeOrigin()\n"
236 "\tReturns the origin of the cone with which to test. The origin\n"
237 "\tis in the middle of the cone.";
238 PyObject* KX_RadarSensor::PyGetConeOrigin(PyObject* self, 
239                                                                                   PyObject* args, 
240                                                                                   PyObject* kwds) {
241         PyObject *retVal = PyList_New(3);
242         
243         PyList_SetItem(retVal, 0, PyFloat_FromDouble(m_cone_origin[0]));
244         PyList_SetItem(retVal, 1, PyFloat_FromDouble(m_cone_origin[1]));
245         PyList_SetItem(retVal, 2, PyFloat_FromDouble(m_cone_origin[2]));
246         
247         return retVal;
248 }
249
250 /* getConeOrigin */
251 char KX_RadarSensor::GetConeTarget_doc[] = 
252 "getConeTarget()\n"
253 "\tReturns the center of the bottom face of the cone with which to test.\n";
254 PyObject* KX_RadarSensor::PyGetConeTarget(PyObject* self, 
255                                                                                   PyObject* args, 
256                                                                                   PyObject* kwds) {
257         PyObject *retVal = PyList_New(3);
258         
259         PyList_SetItem(retVal, 0, PyFloat_FromDouble(m_cone_target[0]));
260         PyList_SetItem(retVal, 1, PyFloat_FromDouble(m_cone_target[1]));
261         PyList_SetItem(retVal, 2, PyFloat_FromDouble(m_cone_target[2]));
262         
263         return retVal;
264 }
265
266 /* getConeOrigin */
267 char KX_RadarSensor::GetConeHeight_doc[] = 
268 "getConeHeight()\n"
269 "\tReturns the height of the cone with which to test.\n";
270 PyObject* KX_RadarSensor::PyGetConeHeight(PyObject* self, 
271                                                                                   PyObject* args, 
272                                                                                   PyObject* kwds) {
273         return PyFloat_FromDouble(m_coneheight);
274 }
275
276