lib: lte_link_control: Don't restore func mode in connect always

Functional mode was restored in connect_lte even if it was
not obtained. This branch wasn't tested in unit tests and
almost impossible to get into in system tests.

Signed-off-by: Tommi Rantanen <[email protected]>

Author: trantanen

lib/lte_link_control/lte_lc.c

@@ -664,6 +664,7 @@ static int connect_lte(bool blocking)
 {
 	int err;
 	enum lte_lc_func_mode original_func_mode;
+	bool func_mode_changed = false;
 	enum lte_lc_nw_reg_status reg_status;
 	static atomic_t in_progress;
 
@@ -705,14 +706,16 @@ static int connect_lte(bool blocking)
 		goto exit;
 	}
 
+	func_mode_changed = true;
+
 	err = k_sem_take(&link, K_SECONDS(CONFIG_LTE_NETWORK_TIMEOUT));
 	if (err == -EAGAIN) {
 		LOG_INF("Network connection attempt timed out");
 		err = -ETIMEDOUT;
 	}
 
 exit:
-	if (err) {
+	if (err && func_mode_changed) {
 		/* Connecting to LTE network failed, restore original functional mode. */
 		lte_lc_func_mode_set(original_func_mode);
 	}