Fixed bug in planned position