Cleanup + Better Status LED logic
Changed Poor End Motor Logic that was causing backwards running