Fix shooter, add some logging back to safety controller