Update planning.cpp