Todo: Implementation of motion planner which will make given UGV or any automated vehicle follow given path.