void getBatteryLevel()

in i2c_pkg/src/battery_node.cpp [92:111]

• 18 lines of code
• 4 McCabe index (conditional complexity)

        void getBatteryLevel (const std::shared_ptr<rmw_request_id_t> request_header,
                              const std::shared_ptr<deepracer_interfaces_pkg::srv::BatteryLevelSrv::Request> req,
                              std::shared_ptr<deepracer_interfaces_pkg::srv::BatteryLevelSrv::Response> res) {
            (void)request_header;
            (void) req;
            int levelByte = batteryPin_.readByte(REGISTER_ADDR);

            level_ = -1;
            if(levelByte != -1){
                for (const auto& pair : levelMap) {
                    if (levelByte >= pair.first) {
                        level_ = pair.second;
                        break;
                    }
                }
            }

            RCLCPP_INFO(this->get_logger(), "Current battery_life byte:0x%x level:%d", levelByte, level_);
            res->level = level_;
        }