fixed TelemetryFeedback array out of bounds, bug fixes in autonomy handler, increase particle count, adjust for border, allow more theta variance