* @param g
* Geometry to be drawn.
*/
public static void drawGeom(DGeom g) {
DVector3C pos = g.getPosition();
DMatrix3C R = g.getRotation();
if (g instanceof DBox) {
DVector3C sides = ((DBox) g).getLengths();
dsDrawBox(pos, R, sides);
} else if (g instanceof DCylinder) {