added truncated pyramid/frustum to geometry3d
changed camera to use truncated version
added truncated frustum/pyramid to cpp
changed arm/camera fk to not use openrave