~aleteoryx/muditaos

ref: d9a1194e6f203247ebcef4b03f8ce5ebccc7c778 muditaos/module-services/service-cellular/src/VolteHandler.hpp -rw-r--r-- 6.6 KiB
d9a1194e — Lukasz Mastalerz [BH-1688] Create a standard for logs 2 years ago
                                                                                
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
// Copyright (c) 2017-2023, Mudita Sp. z.o.o. All rights reserved.
// For licensing, see https://github.com/mudita/MuditaOS/LICENSE.md

#pragma once

#include <service-cellular/VolteState.hpp>
#include <module-cellular/at/ATFactory.hpp>
#include <module-cellular/at/response.hpp>
#include <module-utils/utility/Utils.hpp>
#include <stdexcept>
#include <string_view>

namespace
{
    struct NonCopyable
    {
        explicit NonCopyable()           = default;
        ~NonCopyable()                   = default;
        NonCopyable(NonCopyable const &) = delete;
        NonCopyable &operator=(NonCopyable const &) = delete;
        NonCopyable(NonCopyable &&)                 = default;
        NonCopyable &operator=(NonCopyable &&) = default;
    };
} // namespace

namespace cellular::service
{
    using namespace at;

    struct QcfgImsResult : Result
    {
        explicit QcfgImsResult(Result &rhs) : Result{std::move(rhs)}
        {}
    };

    template <typename CmuxChannel, typename ModemResponseParser>
    struct VolteHandler : private NonCopyable
    {
        auto switchVolte(CmuxChannel &channel, bool permit, bool enable) -> bool
        {
            if (!permit) {
                if (enable) {
                    LOG_INFO("Requested to enable VoLTE, but not permitted for this operator - disabling");
                }

                enable = false;
            }

            if (enable) {
                // according to Quectel, this setting doesn't have to be reset when disabling
                auto voiceDomainAnswer =
                    channel.cmd(factory(at::AT::QNVFW) + NetworkServiceDomain(NetworkServiceDomain::Type::Voice));
                if (!voiceDomainAnswer) {
                    throw std::runtime_error("Failed to set voice domain before trying to enable VoLTE");
                }

                auto smsDomainAnswer =
                    channel.cmd(factory(at::AT::QNVFW) + NetworkServiceDomain(NetworkServiceDomain::Type::SmsViaIms));
                if (!smsDomainAnswer) {
                    throw std::runtime_error("[VoLTE] failed to set SMS domain before trying to enable VoLTE");
                }

                // can be left as always on: doesn't disturb when VoLTE disabled
                auto qmbnAnswer = channel.cmd(factory(at::AT::QMBNCFG) + std::string("\"autosel\",1"));
                if (!qmbnAnswer) {
                    throw std::runtime_error("[VoLTE] failed to enable MBN auto-select before trying to enable VoLTE");
                }
            }
            else {
                auto smsDomainAnswer =
                    channel.cmd(factory(at::AT::QNVFW) + NetworkServiceDomain(NetworkServiceDomain::Type::SmsViaSgs));
                if (!smsDomainAnswer) {
                    throw std::runtime_error("[VoLTE] failed to reset SMS domain before trying to disable VoLTE");
                }
            }

            auto imsCheckAnswer = channel.cmd(factory(AT::QCFG_IMS));
            if (!imsCheckAnswer) {
                throw std::runtime_error("[VoLTE] modem responded with error to QCFG_IMS");
            }

            bool alreadyConfigured;
            try {
                alreadyConfigured = ModemResponseParser()(QcfgImsResult{imsCheckAnswer}, enable);
            }
            catch (std::runtime_error const &exc) {
                throw;
            }

            if (!alreadyConfigured) {
                using namespace response::qcfg_ims;
                auto imsToggleAnswer = channel.cmd(factory(AT::QCFG_IMS) + "," +
                                                   imsStateToString(enable ? IMSState::Enable : IMSState::Disable));
                if (!imsToggleAnswer) {
                    throw std::runtime_error("[VoLTE] failed to " + std::string(enable ? "enable" : "disable") +
                                             " IMS");
                }

                volteState.enablement = enable ? cellular::VolteState::Enablement::SwitchingToOn
                                               : cellular::VolteState::Enablement::SwitchingToOff;
                isFirstRunAfterSwitch = false;
            }
            else {
                if (volteState.enablement == cellular::VolteState::Enablement::SwitchingToOn ||
                    volteState.enablement == cellular::VolteState::Enablement::SwitchingToOff) {
                    isFirstRunAfterSwitch = true;
                }
                volteState.enablement =
                    enable ? cellular::VolteState::Enablement::On : cellular::VolteState::Enablement::Off;
            }

            volteState.permitted = permit;
            return alreadyConfigured;
        }

        auto switchVolte(CmuxChannel &channel, bool permit, bool enable, bool beta) -> bool
        {
            volteState.beta = beta;
            return switchVolte(channel, permit, enable);
        }

        auto getVolteState() -> cellular::VolteState
        {
            return volteState;
        }

        auto isFunctionalityResetNeeded() -> bool
        {
            return isFirstRunAfterSwitch;
        }

        struct NetworkServiceDomain
        {
            enum class Type
            {
                SmsViaIms,
                SmsViaSgs,
                Voice
            };
            explicit NetworkServiceDomain(Type type) : type_{type}
            {
                switch (type) {
                case Type::SmsViaSgs:
                    domain_     = "sms";
                    preference_ = 0x00;
                    return;
                case Type::SmsViaIms:
                    domain_     = "sms";
                    preference_ = 0x01;
                    return;
                case Type::Voice:
                    domain_     = "voice";
                    preference_ = 0x03;
                    return;
                default:
                    throw std::logic_error("[VoLTE] unimplemented network service domain: " +
                                           std::string(magic_enum::enum_name(type)));
                }
            }

            operator std::string()
            {
                return "\"/nv/item_files/modem/mmode/" + domain_ + "_domain_pref\"," +
                       utils::byteToHex<std::uint8_t>(preference_);
            }

          private:
            std::string domain_;
            Type type_;
            std::uint8_t preference_;
        };

      private:
        std::string imsStateToString(response::qcfg_ims::IMSState imsState) const
        {
            return std::to_string(magic_enum::enum_integer(imsState));
        }

        cellular::VolteState volteState;
        bool isFirstRunAfterSwitch      = false;
    };
} // namespace cellular::service