Modifed structure of velocity profile, fixed pid related bugs
Added buffer functionality