Implement ForwardGeometry interface and ForwardGeometryChoreonoid (close #14)
Partial resolution of #4 and #12