Create controller2.cpp

added trajectory points 2 and 3