limit acceleration after filtering
implemented backup plan if robot is stuck