encoder counts added to diagnostics; compass revised