271 |
|
painCave.isFatal = 1; |
272 |
|
simError(); |
273 |
|
} |
274 |
+ |
} |
275 |
+ |
|
276 |
+ |
void StuntDouble::getQ(double q[4] ){ |
277 |
+ |
switch (objType) |
278 |
+ |
{ |
279 |
+ |
case OT_ATOM: |
280 |
+ |
sprintf( painCave.errMsg, |
281 |
+ |
"StuntDouble::getJ was called for a regular atom.\n" |
282 |
+ |
"\tRegular Atoms don't have angular momentum. Be smarter.\n"); |
283 |
+ |
painCave.isFatal = 0; |
284 |
+ |
simError(); |
285 |
+ |
// Return zeros. |
286 |
+ |
q[0] = 0; |
287 |
+ |
q[1] = 0; |
288 |
+ |
q[2] = 0; |
289 |
+ |
q[3] = 0; |
290 |
+ |
break; |
291 |
+ |
case OT_DATOM: |
292 |
+ |
((DirectionalAtom*)this)->getQ(q); |
293 |
+ |
break; |
294 |
+ |
case OT_RIGIDBODY: |
295 |
+ |
((RigidBody*)this)->getQ(q); |
296 |
+ |
break; |
297 |
+ |
default: |
298 |
+ |
sprintf( painCave.errMsg, |
299 |
+ |
"Unrecognized ObjType (%d) in StuntDouble::getJ.\n", |
300 |
+ |
objType ); |
301 |
+ |
painCave.isFatal = 1; |
302 |
+ |
simError(); |
303 |
+ |
} |
304 |
|
} |
305 |
|
|
306 |
+ |
void StuntDouble::setQ(double q[4] ){ |
307 |
+ |
switch (objType) |
308 |
+ |
{ |
309 |
+ |
case OT_ATOM: |
310 |
+ |
sprintf( painCave.errMsg, |
311 |
+ |
"StuntDouble::setJ was called for a regular atom.\n" |
312 |
+ |
"\tRegular Atoms don't have angular momentum. Be smarter.\n"); |
313 |
+ |
painCave.isFatal = 1; |
314 |
+ |
simError(); |
315 |
+ |
break; |
316 |
+ |
case OT_DATOM: |
317 |
+ |
((DirectionalAtom*)this)->setJ(q); |
318 |
+ |
break; |
319 |
+ |
case OT_RIGIDBODY: |
320 |
+ |
((RigidBody*)this)->setJ(q); |
321 |
+ |
break; |
322 |
+ |
default: |
323 |
+ |
sprintf( painCave.errMsg, |
324 |
+ |
"Unrecognized ObjType (%d) in StuntDouble::setJ.\n", |
325 |
+ |
objType ); |
326 |
+ |
painCave.isFatal = 1; |
327 |
+ |
simError(); |
328 |
+ |
} |
329 |
+ |
} |
330 |
|
void StuntDouble::getTrq(double trq[3]){ |
331 |
|
switch (objType) |
332 |
|
{ |