Removed a lot of files in the arm planner that aren't used anymore.
Added SBPLKinematicModel which is a very simple abstract class for FK & IK to be used by the planner
Added a child class of the SBPLKinematicModel that uses the KDL for FK & IK
KDL kinematic model is almost ready for testing.