uqmi: fix network registration loop
[openwrt/openwrt.git] / package / network / utils / uqmi / files / lib / netifd / proto / qmi.sh
index f4b30b87eb7970451ab8a638f6c7383d7ce37495..c0134f44dde3e5755456744c7f083013f8580ac9 100755 (executable)
@@ -19,21 +19,27 @@ proto_qmi_init_config() {
        proto_config_add_string modes
        proto_config_add_string pdptype
        proto_config_add_int profile
+       proto_config_add_boolean dhcp
        proto_config_add_boolean dhcpv6
        proto_config_add_boolean autoconnect
        proto_config_add_int plmn
        proto_config_add_int timeout
+       proto_config_add_int mtu
        proto_config_add_defaults
 }
 
 proto_qmi_setup() {
        local interface="$1"
-       local dataformat connstat
-       local device apn auth username password pincode delay modes pdptype profile dhcpv6 autoconnect plmn timeout $PROTO_DEFAULT_OPTIONS
+       local dataformat connstat plmn_mode mcc mnc
+       local device apn auth username password pincode delay modes pdptype
+       local profile dhcp dhcpv6 autoconnect plmn timeout mtu $PROTO_DEFAULT_OPTIONS
        local ip4table ip6table
        local cid_4 pdh_4 cid_6 pdh_6
        local ip_6 ip_prefix_length gateway_6 dns1_6 dns2_6
-       json_get_vars device apn auth username password pincode delay modes pdptype profile dhcpv6 autoconnect plmn ip4table ip6table timeout $PROTO_DEFAULT_OPTIONS
+
+       json_get_vars device apn auth username password pincode delay modes
+       json_get_vars pdptype profile dhcp dhcpv6 autoconnect plmn ip4table
+       json_get_vars ip6table timeout mtu $PROTO_DEFAULT_OPTIONS
 
        [ "$timeout" = "" ] && timeout="10"
 
@@ -68,11 +74,16 @@ proto_qmi_setup() {
                return 1
        }
 
+       [ -n "$mtu" ] && {
+               echo "Setting MTU to $mtu"
+               /sbin/ip link set dev $ifname mtu $mtu
+       }
+
        echo "Waiting for SIM initialization"
        local uninitialized_timeout=0
        while uqmi -s -d "$device" --get-pin-status | grep '"UIM uninitialized"' > /dev/null; do
                [ -e "$device" ] || return 1
-               if [ "$uninitialized_timeout" -lt "$timeout" ]; then
+               if [ "$uninitialized_timeout" -lt "$timeout" -o "$timeout" = "0" ]; then
                        let uninitialized_timeout++
                        sleep 1;
                else
@@ -141,28 +152,45 @@ proto_qmi_setup() {
                esac
        fi
 
-       [ -n "$plmn" ] && {
-               local mcc mnc
-               if [ "$plmn" = 0 ]; then
+       if [ -n "$plmn" ]; then
+               json_load "$(uqmi -s -d "$device" --get-plmn)"
+               json_get_var plmn_mode mode
+               json_get_vars mcc mnc || {
                        mcc=0
                        mnc=0
-                       echo "Setting PLMN to auto"
-               else
+               }
+
+               if [ "$plmn" = "0" ]; then
+                       if [ "$plmn_mode" != "automatic" ]; then
+                               mcc=0
+                               mnc=0
+                               echo "Setting PLMN to auto"
+                       fi
+               elif [ "$mcc" -ne "${plmn:0:3}" -o "$mnc" -ne "${plmn:3}" ]; then
                        mcc=${plmn:0:3}
                        mnc=${plmn:3}
                        echo "Setting PLMN to $plmn"
+               else
+                       mcc=""
+                       mnc=""
                fi
+       fi
+
+       if [ -n "$mcc" -a -n "$mnc" ]; then
                uqmi -s -d "$device" --set-plmn --mcc "$mcc" --mnc "$mnc" > /dev/null 2>&1 || {
                        echo "Unable to set PLMN"
                        proto_notify_error "$interface" PLMN_FAILED
                        proto_block_restart "$interface"
                        return 1
                }
-       }
+       fi
 
        # Cleanup current state if any
        uqmi -s -d "$device" --stop-network 0xffffffff --autoconnect > /dev/null 2>&1
 
+       # Go online
+       uqmi -s -d "$device" --set-device-operating-mode online > /dev/null 2>&1
+
        # Set IP format
        uqmi -s -d "$device" --set-data-format 802.3 > /dev/null 2>&1
        uqmi -s -d "$device" --wda-set-data-format 802.3 > /dev/null 2>&1
@@ -181,19 +209,36 @@ proto_qmi_setup() {
 
        uqmi -s -d "$device" --sync > /dev/null 2>&1
 
+       uqmi -s -d "$device" --network-register > /dev/null 2>&1
+
        echo "Waiting for network registration"
+       sleep 1
        local registration_timeout=0
-       while uqmi -s -d "$device" --get-serving-system | grep '"searching"' > /dev/null; do
-               [ -e "$device" ] || return 1
-               if [ "$registration_timeout" -lt "$timeout" ]; then
-                       let registration_timeout++
-                       sleep 1;
+       local registration_state=""
+       while true; do
+               registration_state=$(uqmi -s -d "$device" --get-serving-system 2>/dev/null | jsonfilter -e "@.registration" 2>/dev/null)
+
+               [ "$registration_state" = "registered" ] && break
+
+               if [ "$registration_state" = "searching" ] || [ "$registration_state" = "not_registered" ]; then
+                       if [ "$registration_timeout" -lt "$timeout" ] || [ "$timeout" = "0" ]; then
+                               [ "$registration_state" = "searching" ] || {
+                                       echo "Device stopped network registration. Restart network registration"
+                                       uqmi -s -d "$device" --network-register > /dev/null 2>&1
+                               }
+                               let registration_timeout++
+                               sleep 1
+                               continue
+                       fi
+                       echo "Network registration failed, registration timeout reached"
                else
-                       echo "Network registration failed"
-                       proto_notify_error "$interface" NETWORK_REGISTRATION_FAILED
-                       proto_block_restart "$interface"
-                       return 1
+                       # registration_state is 'registration_denied' or 'unknown' or ''
+                       echo "Network registration failed (reason: '$registration_state')"
                fi
+
+               proto_notify_error "$interface" NETWORK_REGISTRATION_FAILED
+               proto_block_restart "$interface"
+               return 1
        done
 
        [ -n "$modes" ] && uqmi -s -d "$device" --set-network-modes "$modes" > /dev/null 2>&1
@@ -322,9 +367,9 @@ proto_qmi_setup() {
                                proto_add_dns_server "$dns2_6"
                        }
                        [ -n "$zone" ] && {
-                               proto_add_data
-                               json_add_string zone "$zone"
-                               proto_close_data
+                               proto_add_data
+                               json_add_string zone "$zone"
+                               proto_close_data
                        }
                        proto_send_update "$interface"
                else
@@ -343,15 +388,41 @@ proto_qmi_setup() {
        }
 
        [ -n "$pdh_4" ] && {
-               json_init
-               json_add_string name "${interface}_4"
-               json_add_string ifname "@$interface"
-               json_add_string proto "dhcp"
-               [ -n "$ip4table" ] && json_add_string ip4table "$ip4table"
-               proto_add_dynamic_defaults
-               [ -n "$zone" ] && json_add_string zone "$zone"
-               json_close_object
-               ubus call network add_dynamic "$(json_dump)"
+               if [ "$dhcp" = 0 ]; then
+                       json_load "$(uqmi -s -d $device --set-client-id wds,$cid_4 --get-current-settings)"
+                       json_select ipv4
+                       json_get_var ip_4 ip
+                       json_get_var gateway_4 gateway
+                       json_get_var dns1_4 dns1
+                       json_get_var dns2_4 dns2
+                       json_get_var subnet_4 subnet
+
+                       proto_init_update "$ifname" 1
+                       proto_set_keep 1
+                       proto_add_ipv4_address "$ip_4" "$subnet_4"
+                       proto_add_ipv4_route "$gateway_4" "128"
+                       [ "$defaultroute" = 0 ] || proto_add_ipv4_route "0.0.0.0" 0 "$gateway_4"
+                       [ "$peerdns" = 0 ] || {
+                               proto_add_dns_server "$dns1_4"
+                               proto_add_dns_server "$dns2_4"
+                       }
+                       [ -n "$zone" ] && {
+                               proto_add_data
+                               json_add_string zone "$zone"
+                               proto_close_data
+                       }
+                       proto_send_update "$interface"
+               else
+                       json_init
+                       json_add_string name "${interface}_4"
+                       json_add_string ifname "@$interface"
+                       json_add_string proto "dhcp"
+                       [ -n "$ip4table" ] && json_add_string ip4table "$ip4table"
+                       proto_add_dynamic_defaults
+                       [ -n "$zone" ] && json_add_string zone "$zone"
+                       json_close_object
+                       ubus call network add_dynamic "$(json_dump)"
+               fi
        }
 }