Splits motion_planning_frame.cpp into different files
Merge pull request #122 from marioprats/split_cpp

Splits motion_planning_frame.cpp into different files