Added new class to handle motion planning