Removed some warnings from Clang compiler because of travis problem
Added .cpp for wholebodyinterface. Maybe in the feature we can add some default implementation for some common methods, e.g. addJoints