Change servo position, tweaked PID, added babystep to PC print