| Alexander Hansen | 4e1142d | 2025-07-25 17:07:27 +0200 | [diff] [blame] | 1 | // SPDX-License-Identifier: Apache-2.0 | 
|  | 2 | // SPDX-FileCopyrightText: Copyright 2018 Intel Corporation | 
| James Feist | 3cb5fec | 2018-01-23 14:41:51 -0800 | [diff] [blame] | 3 |  | 
| Christopher Meis | 3cbff97 | 2025-04-09 14:07:22 +0200 | [diff] [blame] | 4 | #include "../utils.hpp" | 
| Brad Bishop | e45d8c7 | 2022-05-25 15:12:53 -0400 | [diff] [blame] | 5 | #include "fru_utils.hpp" | 
| Patrick Venture | a49dc33 | 2019-10-26 08:32:02 -0700 | [diff] [blame] | 6 |  | 
| James Feist | 3cb5fec | 2018-01-23 14:41:51 -0800 | [diff] [blame] | 7 | #include <fcntl.h> | 
| James Feist | 3b86098 | 2018-10-02 14:34:07 -0700 | [diff] [blame] | 8 | #include <sys/inotify.h> | 
|  | 9 | #include <sys/ioctl.h> | 
|  | 10 |  | 
| Ed Tanous | 34c3e01 | 2023-03-06 13:42:00 -0800 | [diff] [blame] | 11 | #include <boost/asio/io_context.hpp> | 
| Ed Tanous | aa497ed | 2023-02-28 13:43:41 -0800 | [diff] [blame] | 12 | #include <boost/asio/steady_timer.hpp> | 
| James Feist | 3b86098 | 2018-10-02 14:34:07 -0700 | [diff] [blame] | 13 | #include <boost/container/flat_map.hpp> | 
| James Feist | 8c505da | 2020-05-28 10:06:33 -0700 | [diff] [blame] | 14 | #include <nlohmann/json.hpp> | 
| Alexander Hansen | c3db2c3 | 2024-08-20 15:01:38 +0200 | [diff] [blame] | 15 | #include <phosphor-logging/lg2.hpp> | 
| James Feist | 8c505da | 2020-05-28 10:06:33 -0700 | [diff] [blame] | 16 | #include <sdbusplus/asio/connection.hpp> | 
|  | 17 | #include <sdbusplus/asio/object_server.hpp> | 
|  | 18 |  | 
|  | 19 | #include <array> | 
| Ed Tanous | 07d467b | 2021-02-23 14:48:37 -0800 | [diff] [blame] | 20 | #include <cerrno> | 
| Ed Tanous | 3013fb4 | 2022-07-09 08:27:06 -0700 | [diff] [blame] | 21 | #include <charconv> | 
| James Feist | 3b86098 | 2018-10-02 14:34:07 -0700 | [diff] [blame] | 22 | #include <chrono> | 
|  | 23 | #include <ctime> | 
| Patrick Venture | e375400 | 2019-08-06 09:39:12 -0700 | [diff] [blame] | 24 | #include <filesystem> | 
| James Feist | 3cb5fec | 2018-01-23 14:41:51 -0800 | [diff] [blame] | 25 | #include <fstream> | 
| Patrick Venture | baba767 | 2019-10-26 09:26:41 -0700 | [diff] [blame] | 26 | #include <functional> | 
| James Feist | 3cb5fec | 2018-01-23 14:41:51 -0800 | [diff] [blame] | 27 | #include <future> | 
| Patrick Venture | c50e1ff | 2019-08-06 10:22:28 -0700 | [diff] [blame] | 28 | #include <iomanip> | 
| James Feist | 3cb5fec | 2018-01-23 14:41:51 -0800 | [diff] [blame] | 29 | #include <iostream> | 
| Patrick Venture | e26395d | 2019-10-29 14:05:16 -0700 | [diff] [blame] | 30 | #include <limits> | 
| Andrew Jeffery | a9c5892 | 2021-06-01 09:28:59 +0930 | [diff] [blame] | 31 | #include <map> | 
| Bonnie Lo | bfda2c4 | 2022-10-26 16:50:54 +0800 | [diff] [blame] | 32 | #include <optional> | 
| James Feist | 3f8a278 | 2018-02-12 09:24:42 -0800 | [diff] [blame] | 33 | #include <regex> | 
| Patrick Venture | c50e1ff | 2019-08-06 10:22:28 -0700 | [diff] [blame] | 34 | #include <set> | 
|  | 35 | #include <sstream> | 
| Patrick Venture | 11f1ff4 | 2019-08-01 10:42:12 -0700 | [diff] [blame] | 36 | #include <string> | 
| James Feist | 3b86098 | 2018-10-02 14:34:07 -0700 | [diff] [blame] | 37 | #include <thread> | 
| Jeremy Kerr | 4e6a62f | 2020-06-09 11:26:40 +0800 | [diff] [blame] | 38 | #include <utility> | 
| James Feist | a465ccc | 2019-02-08 12:51:01 -0800 | [diff] [blame] | 39 | #include <variant> | 
| Patrick Venture | c274f2f | 2019-10-26 09:27:23 -0700 | [diff] [blame] | 40 | #include <vector> | 
| James Feist | 3b86098 | 2018-10-02 14:34:07 -0700 | [diff] [blame] | 41 |  | 
| James Feist | 8c505da | 2020-05-28 10:06:33 -0700 | [diff] [blame] | 42 | extern "C" | 
|  | 43 | { | 
| James Feist | 3b86098 | 2018-10-02 14:34:07 -0700 | [diff] [blame] | 44 | #include <i2c/smbus.h> | 
|  | 45 | #include <linux/i2c-dev.h> | 
|  | 46 | } | 
| James Feist | 3cb5fec | 2018-01-23 14:41:51 -0800 | [diff] [blame] | 47 |  | 
| Ed Tanous | 072e25d | 2018-12-16 21:45:20 -0800 | [diff] [blame] | 48 | namespace fs = std::filesystem; | 
| Ed Tanous | 07d467b | 2021-02-23 14:48:37 -0800 | [diff] [blame] | 49 | constexpr size_t maxFruSize = 512; | 
|  | 50 | constexpr size_t maxEepromPageIndex = 255; | 
| ankita prasad | 7329a22 | 2023-07-07 09:18:10 +0000 | [diff] [blame] | 51 | constexpr size_t busTimeoutSeconds = 10; | 
| James Feist | 3cb5fec | 2018-01-23 14:41:51 -0800 | [diff] [blame] | 52 |  | 
| Matt Simmering | 2447c24 | 2023-11-09 14:18:39 -0800 | [diff] [blame] | 53 | constexpr const char* blocklistPath = PACKAGE_DIR "blacklist.json"; | 
| Patrick Venture | 11f1ff4 | 2019-08-01 10:42:12 -0700 | [diff] [blame] | 54 |  | 
| Ed Tanous | 07d467b | 2021-02-23 14:48:37 -0800 | [diff] [blame] | 55 | const static constexpr char* baseboardFruLocation = | 
| James Feist | 3cb5fec | 2018-01-23 14:41:51 -0800 | [diff] [blame] | 56 | "/etc/fru/baseboard.fru.bin"; | 
|  | 57 |  | 
| Ed Tanous | 07d467b | 2021-02-23 14:48:37 -0800 | [diff] [blame] | 58 | const static constexpr char* i2CDevLocation = "/dev"; | 
| James Feist | 4131aea | 2018-03-09 09:47:30 -0800 | [diff] [blame] | 59 |  | 
| Vu Pham | dac2dfc | 2024-11-05 12:20:42 -0600 | [diff] [blame] | 60 | constexpr const char* fruDevice16BitDetectMode = FRU_DEVICE_16BITDETECTMODE; | 
|  | 61 |  | 
| Ed Tanous | fc17142 | 2024-04-04 17:18:16 -0700 | [diff] [blame] | 62 | // TODO Refactor these to not be globals | 
|  | 63 | // NOLINTBEGIN(cppcoreguidelines-avoid-non-const-global-variables) | 
| Bonnie Lo | bfda2c4 | 2022-10-26 16:50:54 +0800 | [diff] [blame] | 64 | static boost::container::flat_map<size_t, std::optional<std::set<size_t>>> | 
| Matt Simmering | 2447c24 | 2023-11-09 14:18:39 -0800 | [diff] [blame] | 65 | busBlocklist; | 
| James Feist | 6ebf9de | 2018-05-15 15:01:17 -0700 | [diff] [blame] | 66 | struct FindDevicesWithCallback; | 
|  | 67 |  | 
| James Feist | 8a98392 | 2019-10-24 17:11:56 -0700 | [diff] [blame] | 68 | static boost::container::flat_map< | 
|  | 69 | std::pair<size_t, size_t>, std::shared_ptr<sdbusplus::asio::dbus_interface>> | 
|  | 70 | foundDevices; | 
|  | 71 |  | 
| James Feist | 7972bb9 | 2019-11-13 15:59:24 -0800 | [diff] [blame] | 72 | static boost::container::flat_map<size_t, std::set<size_t>> failedAddresses; | 
| AKSHAY RAVEENDRAN K | 4d4df5b | 2022-11-14 11:16:29 +0000 | [diff] [blame] | 73 | static boost::container::flat_map<size_t, std::set<size_t>> fruAddresses; | 
| James Feist | 7972bb9 | 2019-11-13 15:59:24 -0800 | [diff] [blame] | 74 |  | 
| Ed Tanous | 34c3e01 | 2023-03-06 13:42:00 -0800 | [diff] [blame] | 75 | boost::asio::io_context io; | 
| Ed Tanous | fc17142 | 2024-04-04 17:18:16 -0700 | [diff] [blame] | 76 | // NOLINTEND(cppcoreguidelines-avoid-non-const-global-variables) | 
| James Feist | 5cb0608 | 2019-10-24 17:11:13 -0700 | [diff] [blame] | 77 |  | 
| Naresh Solanki | cf28896 | 2025-06-06 15:26:11 +0530 | [diff] [blame] | 78 | bool updateFruProperty( | 
|  | 79 | const std::string& propertyValue, uint32_t bus, uint32_t address, | 
| Ed Tanous | 07d467b | 2021-02-23 14:48:37 -0800 | [diff] [blame] | 80 | const std::string& propertyName, | 
| Joshi-Mansi | d73b744 | 2020-03-27 19:10:21 +0530 | [diff] [blame] | 81 | boost::container::flat_map< | 
|  | 82 | std::pair<size_t, size_t>, | 
| Kumar Thangavel | 41a9051 | 2021-11-24 15:44:20 +0530 | [diff] [blame] | 83 | std::shared_ptr<sdbusplus::asio::dbus_interface>>& dbusInterfaceMap, | 
| Jonathan Doman | 2418a61 | 2022-02-14 18:20:58 -0800 | [diff] [blame] | 84 | size_t& unknownBusObjectCount, const bool& powerIsOn, | 
| Sora Su | 12e2d41 | 2025-08-22 14:23:16 +0800 | [diff] [blame] | 85 | sdbusplus::asio::object_server& objServer); | 
| Patrick Venture | baba767 | 2019-10-26 09:26:41 -0700 | [diff] [blame] | 86 |  | 
| Patrick Venture | c50e1ff | 2019-08-06 10:22:28 -0700 | [diff] [blame] | 87 | // Given a bus/address, produce the path in sysfs for an eeprom. | 
|  | 88 | static std::string getEepromPath(size_t bus, size_t address) | 
|  | 89 | { | 
|  | 90 | std::stringstream output; | 
|  | 91 | output << "/sys/bus/i2c/devices/" << bus << "-" << std::right | 
|  | 92 | << std::setfill('0') << std::setw(4) << std::hex << address | 
|  | 93 | << "/eeprom"; | 
|  | 94 | return output.str(); | 
|  | 95 | } | 
|  | 96 |  | 
|  | 97 | static bool hasEepromFile(size_t bus, size_t address) | 
|  | 98 | { | 
|  | 99 | auto path = getEepromPath(bus, address); | 
|  | 100 | try | 
|  | 101 | { | 
|  | 102 | return fs::exists(path); | 
|  | 103 | } | 
|  | 104 | catch (...) | 
|  | 105 | { | 
|  | 106 | return false; | 
|  | 107 | } | 
|  | 108 | } | 
|  | 109 |  | 
| Zev Weiss | 309c0b1 | 2022-02-25 01:44:12 +0000 | [diff] [blame] | 110 | static int64_t readFromEeprom(int fd, off_t offset, size_t len, uint8_t* buf) | 
| Patrick Venture | c50e1ff | 2019-08-06 10:22:28 -0700 | [diff] [blame] | 111 | { | 
|  | 112 | auto result = lseek(fd, offset, SEEK_SET); | 
|  | 113 | if (result < 0) | 
|  | 114 | { | 
|  | 115 | std::cerr << "failed to seek\n"; | 
|  | 116 | return -1; | 
|  | 117 | } | 
|  | 118 |  | 
| Patrick Venture | 3ac8e4f | 2019-10-28 13:07:21 -0700 | [diff] [blame] | 119 | return read(fd, buf, len); | 
| Patrick Venture | c50e1ff | 2019-08-06 10:22:28 -0700 | [diff] [blame] | 120 | } | 
|  | 121 |  | 
| Ed Tanous | 3013fb4 | 2022-07-09 08:27:06 -0700 | [diff] [blame] | 122 | static int busStrToInt(const std::string_view busName) | 
| James Feist | 5d7f469 | 2020-06-17 18:22:33 -0700 | [diff] [blame] | 123 | { | 
| Ed Tanous | 07d467b | 2021-02-23 14:48:37 -0800 | [diff] [blame] | 124 | auto findBus = busName.rfind('-'); | 
| James Feist | 5d7f469 | 2020-06-17 18:22:33 -0700 | [diff] [blame] | 125 | if (findBus == std::string::npos) | 
|  | 126 | { | 
|  | 127 | return -1; | 
|  | 128 | } | 
| Ed Tanous | 3013fb4 | 2022-07-09 08:27:06 -0700 | [diff] [blame] | 129 | std::string_view num = busName.substr(findBus + 1); | 
|  | 130 | int val = 0; | 
| Alexander Hansen | 5df916f | 2025-09-26 10:31:36 -0400 | [diff] [blame] | 131 | bool fullMatch = false; | 
|  | 132 | fromCharsWrapper(num, val, fullMatch); | 
| Ed Tanous | 3013fb4 | 2022-07-09 08:27:06 -0700 | [diff] [blame] | 133 | return val; | 
| James Feist | 5d7f469 | 2020-06-17 18:22:33 -0700 | [diff] [blame] | 134 | } | 
|  | 135 |  | 
| James Feist | 7972bb9 | 2019-11-13 15:59:24 -0800 | [diff] [blame] | 136 | static int getRootBus(size_t bus) | 
|  | 137 | { | 
|  | 138 | auto ec = std::error_code(); | 
|  | 139 | auto path = std::filesystem::read_symlink( | 
| Patrick Williams | b707743 | 2024-08-16 15:22:21 -0400 | [diff] [blame] | 140 | std::filesystem::path( | 
|  | 141 | "/sys/bus/i2c/devices/i2c-" + std::to_string(bus) + "/mux_device"), | 
| James Feist | 7972bb9 | 2019-11-13 15:59:24 -0800 | [diff] [blame] | 142 | ec); | 
|  | 143 | if (ec) | 
|  | 144 | { | 
|  | 145 | return -1; | 
|  | 146 | } | 
|  | 147 |  | 
|  | 148 | std::string filename = path.filename(); | 
| Ed Tanous | 07d467b | 2021-02-23 14:48:37 -0800 | [diff] [blame] | 149 | auto findBus = filename.find('-'); | 
| James Feist | 7972bb9 | 2019-11-13 15:59:24 -0800 | [diff] [blame] | 150 | if (findBus == std::string::npos) | 
|  | 151 | { | 
|  | 152 | return -1; | 
|  | 153 | } | 
|  | 154 | return std::stoi(filename.substr(0, findBus)); | 
|  | 155 | } | 
|  | 156 |  | 
| James Feist | c95cb14 | 2018-02-26 10:41:42 -0800 | [diff] [blame] | 157 | static bool isMuxBus(size_t bus) | 
|  | 158 | { | 
| Zhikui Ren | 8af5d3c | 2023-08-09 20:35:35 -0700 | [diff] [blame] | 159 | auto ec = std::error_code(); | 
|  | 160 | auto isSymlink = | 
|  | 161 | is_symlink(std::filesystem::path("/sys/bus/i2c/devices/i2c-" + | 
|  | 162 | std::to_string(bus) + "/mux_device"), | 
|  | 163 | ec); | 
|  | 164 | return (!ec && isSymlink); | 
| James Feist | c95cb14 | 2018-02-26 10:41:42 -0800 | [diff] [blame] | 165 | } | 
|  | 166 |  | 
| Kumar Thangavel | 7f43ea8 | 2021-12-07 17:20:16 +0530 | [diff] [blame] | 167 | static void makeProbeInterface(size_t bus, size_t address, | 
|  | 168 | sdbusplus::asio::object_server& objServer) | 
| James Feist | 8a98392 | 2019-10-24 17:11:56 -0700 | [diff] [blame] | 169 | { | 
|  | 170 | if (isMuxBus(bus)) | 
|  | 171 | { | 
|  | 172 | return; // the mux buses are random, no need to publish | 
|  | 173 | } | 
|  | 174 | auto [it, success] = foundDevices.emplace( | 
|  | 175 | std::make_pair(bus, address), | 
|  | 176 | objServer.add_interface( | 
|  | 177 | "/xyz/openbmc_project/FruDevice/" + std::to_string(bus) + "_" + | 
|  | 178 | std::to_string(address), | 
|  | 179 | "xyz.openbmc_project.Inventory.Item.I2CDevice")); | 
|  | 180 | if (!success) | 
|  | 181 | { | 
|  | 182 | return; // already added | 
|  | 183 | } | 
|  | 184 | it->second->register_property("Bus", bus); | 
|  | 185 | it->second->register_property("Address", address); | 
|  | 186 | it->second->initialize(); | 
|  | 187 | } | 
|  | 188 |  | 
| Matt Simmering | 2447c24 | 2023-11-09 14:18:39 -0800 | [diff] [blame] | 189 | // Issue an I2C transaction to first write to_target_buf_len bytes,then read | 
|  | 190 | // from_target_buf_len bytes. | 
| Patrick Williams | b707743 | 2024-08-16 15:22:21 -0400 | [diff] [blame] | 191 | static int i2cSmbusWriteThenRead( | 
|  | 192 | int file, uint16_t address, uint8_t* toTargetBuf, uint8_t toTargetBufLen, | 
|  | 193 | uint8_t* fromTargetBuf, uint8_t fromTargetBufLen) | 
| Vijay Khemka | 2d681f6 | 2018-11-06 15:51:00 -0800 | [diff] [blame] | 194 | { | 
| Matt Simmering | 2447c24 | 2023-11-09 14:18:39 -0800 | [diff] [blame] | 195 | if (toTargetBuf == nullptr || toTargetBufLen == 0 || | 
|  | 196 | fromTargetBuf == nullptr || fromTargetBufLen == 0) | 
| Xiang Liu | 2801a70 | 2020-01-20 14:29:34 -0800 | [diff] [blame] | 197 | { | 
|  | 198 | return -1; | 
|  | 199 | } | 
| Vijay Khemka | 2d681f6 | 2018-11-06 15:51:00 -0800 | [diff] [blame] | 200 |  | 
| Ed Tanous | 3013fb4 | 2022-07-09 08:27:06 -0700 | [diff] [blame] | 201 | constexpr size_t smbusWriteThenReadMsgCount = 2; | 
|  | 202 | std::array<struct i2c_msg, smbusWriteThenReadMsgCount> msgs{}; | 
| Patrick Williams | a41f014 | 2024-12-18 11:22:53 -0500 | [diff] [blame] | 203 | struct i2c_rdwr_ioctl_data rdwr{}; | 
| Xiang Liu | 2801a70 | 2020-01-20 14:29:34 -0800 | [diff] [blame] | 204 |  | 
|  | 205 | msgs[0].addr = address; | 
|  | 206 | msgs[0].flags = 0; | 
| Matt Simmering | 2447c24 | 2023-11-09 14:18:39 -0800 | [diff] [blame] | 207 | msgs[0].len = toTargetBufLen; | 
|  | 208 | msgs[0].buf = toTargetBuf; | 
| Xiang Liu | 2801a70 | 2020-01-20 14:29:34 -0800 | [diff] [blame] | 209 | msgs[1].addr = address; | 
|  | 210 | msgs[1].flags = I2C_M_RD; | 
| Matt Simmering | 2447c24 | 2023-11-09 14:18:39 -0800 | [diff] [blame] | 211 | msgs[1].len = fromTargetBufLen; | 
|  | 212 | msgs[1].buf = fromTargetBuf; | 
| Xiang Liu | 2801a70 | 2020-01-20 14:29:34 -0800 | [diff] [blame] | 213 |  | 
| Ed Tanous | 3013fb4 | 2022-07-09 08:27:06 -0700 | [diff] [blame] | 214 | rdwr.msgs = msgs.data(); | 
|  | 215 | rdwr.nmsgs = msgs.size(); | 
| Xiang Liu | 2801a70 | 2020-01-20 14:29:34 -0800 | [diff] [blame] | 216 |  | 
|  | 217 | int ret = ioctl(file, I2C_RDWR, &rdwr); | 
|  | 218 |  | 
| Jason M. Bills | f6e4c1f | 2022-08-19 12:23:51 -0700 | [diff] [blame] | 219 | return (ret == static_cast<int>(msgs.size())) ? msgs[1].len : -1; | 
| Xiang Liu | 2801a70 | 2020-01-20 14:29:34 -0800 | [diff] [blame] | 220 | } | 
|  | 221 |  | 
| Marvin Drees | 2b3ed30 | 2023-04-14 16:35:14 +0200 | [diff] [blame] | 222 | static int64_t readData(bool is16bit, bool isBytewise, int file, | 
|  | 223 | uint16_t address, off_t offset, size_t len, | 
|  | 224 | uint8_t* buf) | 
| Xiang Liu | 2801a70 | 2020-01-20 14:29:34 -0800 | [diff] [blame] | 225 | { | 
| Zev Weiss | 309c0b1 | 2022-02-25 01:44:12 +0000 | [diff] [blame] | 226 | if (!is16bit) | 
| Vijay Khemka | 2d681f6 | 2018-11-06 15:51:00 -0800 | [diff] [blame] | 227 | { | 
| Marvin Drees | 2b3ed30 | 2023-04-14 16:35:14 +0200 | [diff] [blame] | 228 | if (!isBytewise) | 
|  | 229 | { | 
|  | 230 | return i2c_smbus_read_i2c_block_data( | 
|  | 231 | file, static_cast<uint8_t>(offset), len, buf); | 
|  | 232 | } | 
|  | 233 |  | 
|  | 234 | std::span<uint8_t> bufspan{buf, len}; | 
|  | 235 | for (size_t i = 0; i < len; i++) | 
|  | 236 | { | 
|  | 237 | int byte = i2c_smbus_read_byte_data( | 
|  | 238 | file, static_cast<uint8_t>(offset + i)); | 
|  | 239 | if (byte < 0) | 
|  | 240 | { | 
|  | 241 | return static_cast<int64_t>(byte); | 
|  | 242 | } | 
|  | 243 | bufspan[i] = static_cast<uint8_t>(byte); | 
|  | 244 | } | 
|  | 245 | return static_cast<int64_t>(len); | 
| Vijay Khemka | 2d681f6 | 2018-11-06 15:51:00 -0800 | [diff] [blame] | 246 | } | 
|  | 247 |  | 
| Xiang Liu | 2801a70 | 2020-01-20 14:29:34 -0800 | [diff] [blame] | 248 | offset = htobe16(offset); | 
| Ed Tanous | 3013fb4 | 2022-07-09 08:27:06 -0700 | [diff] [blame] | 249 | // NOLINTNEXTLINE(cppcoreguidelines-pro-type-reinterpret-cast) | 
|  | 250 | uint8_t* u8Offset = reinterpret_cast<uint8_t*>(&offset); | 
|  | 251 | return i2cSmbusWriteThenRead(file, address, u8Offset, 2, buf, len); | 
| Vijay Khemka | 2d681f6 | 2018-11-06 15:51:00 -0800 | [diff] [blame] | 252 | } | 
|  | 253 |  | 
| Vu Pham | dac2dfc | 2024-11-05 12:20:42 -0600 | [diff] [blame] | 254 | // Mode_1: | 
|  | 255 | // -------- | 
|  | 256 | // Please refer to document docs/address_size_detection_modes.md for | 
|  | 257 | // more details and explanations. | 
|  | 258 | static std::optional<bool> isDevice16BitMode1(int file) | 
|  | 259 | { | 
|  | 260 | // Set the higher data word address bits to 0. It's safe on 8-bit | 
|  | 261 | // addressing EEPROMs because it doesn't write any actual data. | 
|  | 262 | int ret = i2c_smbus_write_byte(file, 0); | 
|  | 263 | if (ret < 0) | 
|  | 264 | { | 
|  | 265 | return std::nullopt; | 
|  | 266 | } | 
|  | 267 |  | 
|  | 268 | /* Get first byte */ | 
|  | 269 | int byte1 = i2c_smbus_read_byte_data(file, 0); | 
|  | 270 | if (byte1 < 0) | 
|  | 271 | { | 
|  | 272 | return std::nullopt; | 
|  | 273 | } | 
|  | 274 | /* Read 7 more bytes, it will read same first byte in case of | 
|  | 275 | * 8 bit but it will read next byte in case of 16 bit | 
|  | 276 | */ | 
|  | 277 | for (int i = 0; i < 7; i++) | 
|  | 278 | { | 
|  | 279 | int byte2 = i2c_smbus_read_byte_data(file, 0); | 
|  | 280 | if (byte2 < 0) | 
|  | 281 | { | 
|  | 282 | return std::nullopt; | 
|  | 283 | } | 
|  | 284 | if (byte2 != byte1) | 
|  | 285 | { | 
|  | 286 | return true; | 
|  | 287 | } | 
|  | 288 | } | 
|  | 289 | return false; | 
|  | 290 | } | 
|  | 291 |  | 
|  | 292 | // Mode_2: | 
|  | 293 | // -------- | 
|  | 294 | // Please refer to document docs/address_size_detection_modes.md for | 
|  | 295 | // more details and explanations. | 
|  | 296 | static std::optional<bool> isDevice16BitMode2(int file, uint16_t address) | 
|  | 297 | { | 
|  | 298 | uint8_t first = 0; | 
|  | 299 | uint8_t cur = 0; | 
|  | 300 | uint16_t v = 0; | 
|  | 301 | int ret = 0; | 
|  | 302 | // NOLINTNEXTLINE(cppcoreguidelines-pro-type-reinterpret-cast) | 
|  | 303 | uint8_t* p = reinterpret_cast<uint8_t*>(&v); | 
|  | 304 |  | 
|  | 305 | /* | 
|  | 306 | * Write 2 bytes byte0 = 0, byte1 = {0..7} and then subsequent read byte | 
|  | 307 | * It will read same first byte in case of 8 bit but | 
|  | 308 | * it will read next byte in case of 16 bit | 
|  | 309 | */ | 
|  | 310 | for (int i = 0; i < 8; i++) | 
|  | 311 | { | 
|  | 312 | v = htobe16(i); | 
|  | 313 |  | 
|  | 314 | ret = i2cSmbusWriteThenRead(file, address, p, 2, &cur, 1); | 
|  | 315 | if (ret < 0) | 
|  | 316 | { | 
|  | 317 | return std::nullopt; | 
|  | 318 | } | 
|  | 319 |  | 
|  | 320 | if (i == 0) | 
|  | 321 | { | 
|  | 322 | first = cur; | 
|  | 323 | } | 
|  | 324 |  | 
|  | 325 | if (first != cur) | 
|  | 326 | { | 
|  | 327 | return true; | 
|  | 328 | } | 
|  | 329 | } | 
|  | 330 | return false; | 
|  | 331 | } | 
|  | 332 |  | 
|  | 333 | static std::optional<bool> isDevice16Bit(int file, uint16_t address) | 
|  | 334 | { | 
|  | 335 | std::string mode(fruDevice16BitDetectMode); | 
|  | 336 |  | 
|  | 337 | if (mode == "MODE_2") | 
|  | 338 | { | 
|  | 339 | return isDevice16BitMode2(file, address); | 
|  | 340 | } | 
|  | 341 |  | 
|  | 342 | return isDevice16BitMode1(file); | 
|  | 343 | } | 
|  | 344 |  | 
| Patrick Venture | c50e1ff | 2019-08-06 10:22:28 -0700 | [diff] [blame] | 345 | // TODO: This code is very similar to the non-eeprom version and can be merged | 
|  | 346 | // with some tweaks. | 
| Andrei Kartashev | 1c5b706 | 2020-08-19 14:47:30 +0300 | [diff] [blame] | 347 | static std::vector<uint8_t> processEeprom(int bus, int address) | 
| Patrick Venture | c50e1ff | 2019-08-06 10:22:28 -0700 | [diff] [blame] | 348 | { | 
| Patrick Venture | c50e1ff | 2019-08-06 10:22:28 -0700 | [diff] [blame] | 349 | auto path = getEepromPath(bus, address); | 
|  | 350 |  | 
|  | 351 | int file = open(path.c_str(), O_RDONLY); | 
|  | 352 | if (file < 0) | 
|  | 353 | { | 
|  | 354 | std::cerr << "Unable to open eeprom file: " << path << "\n"; | 
| Patrick Venture | baba767 | 2019-10-26 09:26:41 -0700 | [diff] [blame] | 355 | return {}; | 
| Patrick Venture | c50e1ff | 2019-08-06 10:22:28 -0700 | [diff] [blame] | 356 | } | 
|  | 357 |  | 
| Patrick Venture | baba767 | 2019-10-26 09:26:41 -0700 | [diff] [blame] | 358 | std::string errorMessage = "eeprom at " + std::to_string(bus) + | 
|  | 359 | " address " + std::to_string(address); | 
| Zev Weiss | 309c0b1 | 2022-02-25 01:44:12 +0000 | [diff] [blame] | 360 | auto readFunc = [file](off_t offset, size_t length, uint8_t* outbuf) { | 
|  | 361 | return readFromEeprom(file, offset, length, outbuf); | 
|  | 362 | }; | 
|  | 363 | FRUReader reader(std::move(readFunc)); | 
| Patrick Williams | b707743 | 2024-08-16 15:22:21 -0400 | [diff] [blame] | 364 | std::pair<std::vector<uint8_t>, bool> pair = | 
|  | 365 | readFRUContents(reader, errorMessage); | 
| Patrick Venture | c50e1ff | 2019-08-06 10:22:28 -0700 | [diff] [blame] | 366 |  | 
|  | 367 | close(file); | 
| Marvin Drees | 2b3ed30 | 2023-04-14 16:35:14 +0200 | [diff] [blame] | 368 | return pair.first; | 
| Patrick Venture | c50e1ff | 2019-08-06 10:22:28 -0700 | [diff] [blame] | 369 | } | 
|  | 370 |  | 
| Bonnie Lo | bfda2c4 | 2022-10-26 16:50:54 +0800 | [diff] [blame] | 371 | std::set<size_t> findI2CEeproms(int i2cBus, | 
|  | 372 | const std::shared_ptr<DeviceMap>& devices) | 
| Patrick Venture | c50e1ff | 2019-08-06 10:22:28 -0700 | [diff] [blame] | 373 | { | 
| Bonnie Lo | bfda2c4 | 2022-10-26 16:50:54 +0800 | [diff] [blame] | 374 | std::set<size_t> foundList; | 
| Patrick Venture | c50e1ff | 2019-08-06 10:22:28 -0700 | [diff] [blame] | 375 |  | 
|  | 376 | std::string path = "/sys/bus/i2c/devices/i2c-" + std::to_string(i2cBus); | 
|  | 377 |  | 
|  | 378 | // For each file listed under the i2c device | 
|  | 379 | // NOTE: This should be faster than just checking for each possible address | 
|  | 380 | // path. | 
| Zhikui Ren | 8af5d3c | 2023-08-09 20:35:35 -0700 | [diff] [blame] | 381 | auto ec = std::error_code(); | 
|  | 382 | for (const auto& p : fs::directory_iterator(path, ec)) | 
| Patrick Venture | c50e1ff | 2019-08-06 10:22:28 -0700 | [diff] [blame] | 383 | { | 
| Zhikui Ren | 8af5d3c | 2023-08-09 20:35:35 -0700 | [diff] [blame] | 384 | if (ec) | 
|  | 385 | { | 
|  | 386 | std::cerr << "directory_iterator err " << ec.message() << "\n"; | 
|  | 387 | break; | 
|  | 388 | } | 
| Patrick Venture | c50e1ff | 2019-08-06 10:22:28 -0700 | [diff] [blame] | 389 | const std::string node = p.path().string(); | 
|  | 390 | std::smatch m; | 
| Patrick Williams | b707743 | 2024-08-16 15:22:21 -0400 | [diff] [blame] | 391 | bool found = | 
|  | 392 | std::regex_match(node, m, std::regex(".+\\d+-([0-9abcdef]+$)")); | 
| Patrick Venture | c50e1ff | 2019-08-06 10:22:28 -0700 | [diff] [blame] | 393 |  | 
|  | 394 | if (!found) | 
|  | 395 | { | 
|  | 396 | continue; | 
|  | 397 | } | 
|  | 398 | if (m.size() != 2) | 
|  | 399 | { | 
|  | 400 | std::cerr << "regex didn't capture\n"; | 
|  | 401 | continue; | 
|  | 402 | } | 
|  | 403 |  | 
|  | 404 | std::ssub_match subMatch = m[1]; | 
|  | 405 | std::string addressString = subMatch.str(); | 
| Bonnie Lo | bfda2c4 | 2022-10-26 16:50:54 +0800 | [diff] [blame] | 406 | std::string_view addressStringView(addressString); | 
| Patrick Venture | c50e1ff | 2019-08-06 10:22:28 -0700 | [diff] [blame] | 407 |  | 
| Bonnie Lo | bfda2c4 | 2022-10-26 16:50:54 +0800 | [diff] [blame] | 408 | size_t address = 0; | 
|  | 409 | std::from_chars(addressStringView.begin(), addressStringView.end(), | 
|  | 410 | address, 16); | 
| Patrick Venture | c50e1ff | 2019-08-06 10:22:28 -0700 | [diff] [blame] | 411 |  | 
|  | 412 | const std::string eeprom = node + "/eeprom"; | 
|  | 413 |  | 
|  | 414 | try | 
|  | 415 | { | 
|  | 416 | if (!fs::exists(eeprom)) | 
|  | 417 | { | 
|  | 418 | continue; | 
|  | 419 | } | 
|  | 420 | } | 
|  | 421 | catch (...) | 
|  | 422 | { | 
|  | 423 | continue; | 
|  | 424 | } | 
|  | 425 |  | 
|  | 426 | // There is an eeprom file at this address, it may have invalid | 
|  | 427 | // contents, but we found it. | 
|  | 428 | foundList.insert(address); | 
|  | 429 |  | 
| Andrei Kartashev | 1c5b706 | 2020-08-19 14:47:30 +0300 | [diff] [blame] | 430 | std::vector<uint8_t> device = processEeprom(i2cBus, address); | 
| Patrick Venture | c50e1ff | 2019-08-06 10:22:28 -0700 | [diff] [blame] | 431 | if (!device.empty()) | 
|  | 432 | { | 
|  | 433 | devices->emplace(address, device); | 
|  | 434 | } | 
|  | 435 | } | 
|  | 436 |  | 
|  | 437 | return foundList; | 
|  | 438 | } | 
|  | 439 |  | 
| Andrei Kartashev | 2f0de17 | 2020-08-13 14:29:40 +0300 | [diff] [blame] | 440 | int getBusFRUs(int file, int first, int last, int bus, | 
| Jonathan Doman | 2418a61 | 2022-02-14 18:20:58 -0800 | [diff] [blame] | 441 | std::shared_ptr<DeviceMap> devices, const bool& powerIsOn, | 
| Kumar Thangavel | 7f43ea8 | 2021-12-07 17:20:16 +0530 | [diff] [blame] | 442 | sdbusplus::asio::object_server& objServer) | 
| James Feist | 3cb5fec | 2018-01-23 14:41:51 -0800 | [diff] [blame] | 443 | { | 
| James Feist | 26c27ad | 2018-07-25 15:09:40 -0700 | [diff] [blame] | 444 | std::future<int> future = std::async(std::launch::async, [&]() { | 
| Patrick Venture | c50e1ff | 2019-08-06 10:22:28 -0700 | [diff] [blame] | 445 | // NOTE: When reading the devices raw on the bus, it can interfere with | 
|  | 446 | // the driver's ability to operate, therefore read eeproms first before | 
|  | 447 | // scanning for devices without drivers. Several experiments were run | 
|  | 448 | // and it was determined that if there were any devices on the bus | 
|  | 449 | // before the eeprom was hit and read, the eeprom driver wouldn't open | 
|  | 450 | // while the bus device was open. An experiment was not performed to see | 
|  | 451 | // if this issue was resolved if the i2c bus device was closed, but | 
|  | 452 | // hexdumps of the eeprom later were successful. | 
|  | 453 |  | 
|  | 454 | // Scan for i2c eeproms loaded on this bus. | 
| Bonnie Lo | bfda2c4 | 2022-10-26 16:50:54 +0800 | [diff] [blame] | 455 | std::set<size_t> skipList = findI2CEeproms(bus, devices); | 
| James Feist | 7972bb9 | 2019-11-13 15:59:24 -0800 | [diff] [blame] | 456 | std::set<size_t>& failedItems = failedAddresses[bus]; | 
| AKSHAY RAVEENDRAN K | 4d4df5b | 2022-11-14 11:16:29 +0000 | [diff] [blame] | 457 | std::set<size_t>& foundItems = fruAddresses[bus]; | 
|  | 458 | foundItems.clear(); | 
| James Feist | 7972bb9 | 2019-11-13 15:59:24 -0800 | [diff] [blame] | 459 |  | 
| Matt Simmering | 2447c24 | 2023-11-09 14:18:39 -0800 | [diff] [blame] | 460 | auto busFind = busBlocklist.find(bus); | 
|  | 461 | if (busFind != busBlocklist.end()) | 
| Bonnie Lo | bfda2c4 | 2022-10-26 16:50:54 +0800 | [diff] [blame] | 462 | { | 
|  | 463 | if (busFind->second != std::nullopt) | 
|  | 464 | { | 
|  | 465 | for (const auto& address : *(busFind->second)) | 
|  | 466 | { | 
|  | 467 | skipList.insert(address); | 
|  | 468 | } | 
|  | 469 | } | 
|  | 470 | } | 
|  | 471 |  | 
| James Feist | 7972bb9 | 2019-11-13 15:59:24 -0800 | [diff] [blame] | 472 | std::set<size_t>* rootFailures = nullptr; | 
|  | 473 | int rootBus = getRootBus(bus); | 
|  | 474 |  | 
|  | 475 | if (rootBus >= 0) | 
|  | 476 | { | 
| Matt Simmering | 2447c24 | 2023-11-09 14:18:39 -0800 | [diff] [blame] | 477 | auto rootBusFind = busBlocklist.find(rootBus); | 
|  | 478 | if (rootBusFind != busBlocklist.end()) | 
| Bonnie Lo | bfda2c4 | 2022-10-26 16:50:54 +0800 | [diff] [blame] | 479 | { | 
|  | 480 | if (rootBusFind->second != std::nullopt) | 
|  | 481 | { | 
|  | 482 | for (const auto& rootAddress : *(rootBusFind->second)) | 
|  | 483 | { | 
|  | 484 | skipList.insert(rootAddress); | 
|  | 485 | } | 
|  | 486 | } | 
|  | 487 | } | 
| James Feist | 7972bb9 | 2019-11-13 15:59:24 -0800 | [diff] [blame] | 488 | rootFailures = &(failedAddresses[rootBus]); | 
| AKSHAY RAVEENDRAN K | 4d4df5b | 2022-11-14 11:16:29 +0000 | [diff] [blame] | 489 | foundItems = fruAddresses[rootBus]; | 
| James Feist | 7972bb9 | 2019-11-13 15:59:24 -0800 | [diff] [blame] | 490 | } | 
| Patrick Venture | c50e1ff | 2019-08-06 10:22:28 -0700 | [diff] [blame] | 491 |  | 
| Matt Simmering | 2447c24 | 2023-11-09 14:18:39 -0800 | [diff] [blame] | 492 | constexpr int startSkipTargetAddr = 0; | 
|  | 493 | constexpr int endSkipTargetAddr = 12; | 
| Rajashekar Gade Reddy | fa8d322 | 2020-05-13 08:27:03 +0530 | [diff] [blame] | 494 |  | 
| James Feist | 26c27ad | 2018-07-25 15:09:40 -0700 | [diff] [blame] | 495 | for (int ii = first; ii <= last; ii++) | 
| James Feist | 3cb5fec | 2018-01-23 14:41:51 -0800 | [diff] [blame] | 496 | { | 
| Patrick Williams | 6459993 | 2025-05-14 07:24:20 -0400 | [diff] [blame] | 497 | if (foundItems.contains(ii)) | 
| AKSHAY RAVEENDRAN K | 4d4df5b | 2022-11-14 11:16:29 +0000 | [diff] [blame] | 498 | { | 
|  | 499 | continue; | 
|  | 500 | } | 
| Patrick Williams | 6459993 | 2025-05-14 07:24:20 -0400 | [diff] [blame] | 501 | if (skipList.contains(ii)) | 
| Patrick Venture | c50e1ff | 2019-08-06 10:22:28 -0700 | [diff] [blame] | 502 | { | 
|  | 503 | continue; | 
|  | 504 | } | 
| Rajashekar Gade Reddy | fa8d322 | 2020-05-13 08:27:03 +0530 | [diff] [blame] | 505 | // skipping since no device is present in this range | 
| Matt Simmering | 2447c24 | 2023-11-09 14:18:39 -0800 | [diff] [blame] | 506 | if (ii >= startSkipTargetAddr && ii <= endSkipTargetAddr) | 
| Rajashekar Gade Reddy | fa8d322 | 2020-05-13 08:27:03 +0530 | [diff] [blame] | 507 | { | 
|  | 508 | continue; | 
|  | 509 | } | 
| Matt Simmering | 2447c24 | 2023-11-09 14:18:39 -0800 | [diff] [blame] | 510 | // Set target address | 
| Rajashekar Gade Reddy | fa8d322 | 2020-05-13 08:27:03 +0530 | [diff] [blame] | 511 | if (ioctl(file, I2C_SLAVE, ii) < 0) | 
| James Feist | 3cb5fec | 2018-01-23 14:41:51 -0800 | [diff] [blame] | 512 | { | 
| Andrei Kartashev | b45324a | 2020-10-14 17:01:47 +0300 | [diff] [blame] | 513 | std::cerr << "device at bus " << bus << " address " << ii | 
| Patrick Venture | 5d8b61d | 2019-08-06 12:36:10 -0700 | [diff] [blame] | 514 | << " busy\n"; | 
| James Feist | 26c27ad | 2018-07-25 15:09:40 -0700 | [diff] [blame] | 515 | continue; | 
|  | 516 | } | 
|  | 517 | // probe | 
| Ed Tanous | 07d467b | 2021-02-23 14:48:37 -0800 | [diff] [blame] | 518 | if (i2c_smbus_read_byte(file) < 0) | 
| James Feist | 26c27ad | 2018-07-25 15:09:40 -0700 | [diff] [blame] | 519 | { | 
|  | 520 | continue; | 
|  | 521 | } | 
| James Feist | 3cb5fec | 2018-01-23 14:41:51 -0800 | [diff] [blame] | 522 |  | 
| Alexander Hansen | c3db2c3 | 2024-08-20 15:01:38 +0200 | [diff] [blame] | 523 | lg2::debug("something at bus {BUS}, addr {ADDR}", "BUS", bus, | 
|  | 524 | "ADDR", ii); | 
| Vijay Khemka | 2d681f6 | 2018-11-06 15:51:00 -0800 | [diff] [blame] | 525 |  | 
| Kumar Thangavel | 7f43ea8 | 2021-12-07 17:20:16 +0530 | [diff] [blame] | 526 | makeProbeInterface(bus, ii, objServer); | 
| James Feist | 8a98392 | 2019-10-24 17:11:56 -0700 | [diff] [blame] | 527 |  | 
| Patrick Williams | 6459993 | 2025-05-14 07:24:20 -0400 | [diff] [blame] | 528 | if (failedItems.contains(ii)) | 
| James Feist | 7972bb9 | 2019-11-13 15:59:24 -0800 | [diff] [blame] | 529 | { | 
|  | 530 | // if we failed to read it once, unlikely we can read it later | 
|  | 531 | continue; | 
|  | 532 | } | 
|  | 533 |  | 
|  | 534 | if (rootFailures != nullptr) | 
|  | 535 | { | 
| Patrick Williams | 6459993 | 2025-05-14 07:24:20 -0400 | [diff] [blame] | 536 | if (rootFailures->contains(ii)) | 
| James Feist | 7972bb9 | 2019-11-13 15:59:24 -0800 | [diff] [blame] | 537 | { | 
|  | 538 | continue; | 
|  | 539 | } | 
|  | 540 | } | 
|  | 541 |  | 
| Vijay Khemka | 2d681f6 | 2018-11-06 15:51:00 -0800 | [diff] [blame] | 542 | /* Check for Device type if it is 8 bit or 16 bit */ | 
| Vu Pham | dac2dfc | 2024-11-05 12:20:42 -0600 | [diff] [blame] | 543 | std::optional<bool> is16Bit = isDevice16Bit(file, ii); | 
| Zev Weiss | 309c0b1 | 2022-02-25 01:44:12 +0000 | [diff] [blame] | 544 | if (!is16Bit.has_value()) | 
| Vijay Khemka | 2d681f6 | 2018-11-06 15:51:00 -0800 | [diff] [blame] | 545 | { | 
|  | 546 | std::cerr << "failed to read bus " << bus << " address " << ii | 
|  | 547 | << "\n"; | 
| James Feist | cb5661d | 2020-06-12 15:05:01 -0700 | [diff] [blame] | 548 | if (powerIsOn) | 
|  | 549 | { | 
|  | 550 | failedItems.insert(ii); | 
|  | 551 | } | 
| Vijay Khemka | 2d681f6 | 2018-11-06 15:51:00 -0800 | [diff] [blame] | 552 | continue; | 
|  | 553 | } | 
| Zev Weiss | 309c0b1 | 2022-02-25 01:44:12 +0000 | [diff] [blame] | 554 | bool is16BitBool{*is16Bit}; | 
| Vijay Khemka | 2d681f6 | 2018-11-06 15:51:00 -0800 | [diff] [blame] | 555 |  | 
| Patrick Williams | b707743 | 2024-08-16 15:22:21 -0400 | [diff] [blame] | 556 | auto readFunc = [is16BitBool, file, | 
|  | 557 | ii](off_t offset, size_t length, uint8_t* outbuf) { | 
| Marvin Drees | 2b3ed30 | 2023-04-14 16:35:14 +0200 | [diff] [blame] | 558 | return readData(is16BitBool, false, file, ii, offset, length, | 
|  | 559 | outbuf); | 
| Zev Weiss | 309c0b1 | 2022-02-25 01:44:12 +0000 | [diff] [blame] | 560 | }; | 
|  | 561 | FRUReader reader(std::move(readFunc)); | 
| Patrick Williams | b707743 | 2024-08-16 15:22:21 -0400 | [diff] [blame] | 562 | std::string errorMessage = | 
|  | 563 | "bus " + std::to_string(bus) + " address " + std::to_string(ii); | 
| Marvin Drees | 2b3ed30 | 2023-04-14 16:35:14 +0200 | [diff] [blame] | 564 | std::pair<std::vector<uint8_t>, bool> pair = | 
|  | 565 | readFRUContents(reader, errorMessage); | 
|  | 566 | const bool foundHeader = pair.second; | 
|  | 567 |  | 
|  | 568 | if (!foundHeader && !is16BitBool) | 
|  | 569 | { | 
|  | 570 | // certain FRU eeproms require bytewise reading. | 
|  | 571 | // otherwise garbage is read. e.g. SuperMicro PWS 920P-SQ | 
|  | 572 |  | 
| Patrick Williams | b707743 | 2024-08-16 15:22:21 -0400 | [diff] [blame] | 573 | auto readFunc = | 
|  | 574 | [is16BitBool, file, | 
|  | 575 | ii](off_t offset, size_t length, uint8_t* outbuf) { | 
|  | 576 | return readData(is16BitBool, true, file, ii, offset, | 
|  | 577 | length, outbuf); | 
|  | 578 | }; | 
| Marvin Drees | 2b3ed30 | 2023-04-14 16:35:14 +0200 | [diff] [blame] | 579 | FRUReader readerBytewise(std::move(readFunc)); | 
|  | 580 | pair = readFRUContents(readerBytewise, errorMessage); | 
|  | 581 | } | 
|  | 582 |  | 
|  | 583 | if (pair.first.empty()) | 
| James Feist | 26c27ad | 2018-07-25 15:09:40 -0700 | [diff] [blame] | 584 | { | 
| James Feist | 26c27ad | 2018-07-25 15:09:40 -0700 | [diff] [blame] | 585 | continue; | 
|  | 586 | } | 
| James Feist | 26c27ad | 2018-07-25 15:09:40 -0700 | [diff] [blame] | 587 |  | 
| Marvin Drees | 2b3ed30 | 2023-04-14 16:35:14 +0200 | [diff] [blame] | 588 | devices->emplace(ii, pair.first); | 
| AKSHAY RAVEENDRAN K | 4d4df5b | 2022-11-14 11:16:29 +0000 | [diff] [blame] | 589 | fruAddresses[bus].insert(ii); | 
| James Feist | 3cb5fec | 2018-01-23 14:41:51 -0800 | [diff] [blame] | 590 | } | 
| James Feist | 26c27ad | 2018-07-25 15:09:40 -0700 | [diff] [blame] | 591 | return 1; | 
|  | 592 | }); | 
|  | 593 | std::future_status status = | 
|  | 594 | future.wait_for(std::chrono::seconds(busTimeoutSeconds)); | 
|  | 595 | if (status == std::future_status::timeout) | 
|  | 596 | { | 
|  | 597 | std::cerr << "Error reading bus " << bus << "\n"; | 
| James Feist | cb5661d | 2020-06-12 15:05:01 -0700 | [diff] [blame] | 598 | if (powerIsOn) | 
|  | 599 | { | 
| Matt Simmering | 2447c24 | 2023-11-09 14:18:39 -0800 | [diff] [blame] | 600 | busBlocklist[bus] = std::nullopt; | 
| James Feist | cb5661d | 2020-06-12 15:05:01 -0700 | [diff] [blame] | 601 | } | 
| James Feist | 444830e | 2019-04-05 08:38:16 -0700 | [diff] [blame] | 602 | close(file); | 
| James Feist | 26c27ad | 2018-07-25 15:09:40 -0700 | [diff] [blame] | 603 | return -1; | 
| James Feist | 3cb5fec | 2018-01-23 14:41:51 -0800 | [diff] [blame] | 604 | } | 
|  | 605 |  | 
| James Feist | 444830e | 2019-04-05 08:38:16 -0700 | [diff] [blame] | 606 | close(file); | 
| James Feist | 26c27ad | 2018-07-25 15:09:40 -0700 | [diff] [blame] | 607 | return future.get(); | 
| James Feist | 3cb5fec | 2018-01-23 14:41:51 -0800 | [diff] [blame] | 608 | } | 
|  | 609 |  | 
| Matt Simmering | 2447c24 | 2023-11-09 14:18:39 -0800 | [diff] [blame] | 610 | void loadBlocklist(const char* path) | 
| Patrick Venture | 11f1ff4 | 2019-08-01 10:42:12 -0700 | [diff] [blame] | 611 | { | 
| Matt Simmering | 2447c24 | 2023-11-09 14:18:39 -0800 | [diff] [blame] | 612 | std::ifstream blocklistStream(path); | 
|  | 613 | if (!blocklistStream.good()) | 
| Patrick Venture | 11f1ff4 | 2019-08-01 10:42:12 -0700 | [diff] [blame] | 614 | { | 
|  | 615 | // File is optional. | 
| Matt Simmering | 2447c24 | 2023-11-09 14:18:39 -0800 | [diff] [blame] | 616 | std::cerr << "Cannot open blocklist file.\n\n"; | 
| Patrick Venture | 11f1ff4 | 2019-08-01 10:42:12 -0700 | [diff] [blame] | 617 | return; | 
|  | 618 | } | 
|  | 619 |  | 
| Patrick Williams | b707743 | 2024-08-16 15:22:21 -0400 | [diff] [blame] | 620 | nlohmann::json data = | 
|  | 621 | nlohmann::json::parse(blocklistStream, nullptr, false); | 
| Patrick Venture | 11f1ff4 | 2019-08-01 10:42:12 -0700 | [diff] [blame] | 622 | if (data.is_discarded()) | 
|  | 623 | { | 
| Matt Simmering | 2447c24 | 2023-11-09 14:18:39 -0800 | [diff] [blame] | 624 | std::cerr << "Illegal blocklist file detected, cannot validate JSON, " | 
| Patrick Venture | 11f1ff4 | 2019-08-01 10:42:12 -0700 | [diff] [blame] | 625 | "exiting\n"; | 
|  | 626 | std::exit(EXIT_FAILURE); | 
| Patrick Venture | 11f1ff4 | 2019-08-01 10:42:12 -0700 | [diff] [blame] | 627 | } | 
|  | 628 |  | 
|  | 629 | // It's expected to have at least one field, "buses" that is an array of the | 
|  | 630 | // buses by integer. Allow for future options to exclude further aspects, | 
|  | 631 | // such as specific addresses or ranges. | 
|  | 632 | if (data.type() != nlohmann::json::value_t::object) | 
|  | 633 | { | 
| Matt Simmering | 2447c24 | 2023-11-09 14:18:39 -0800 | [diff] [blame] | 634 | std::cerr << "Illegal blocklist, expected to read dictionary\n"; | 
| Patrick Venture | 11f1ff4 | 2019-08-01 10:42:12 -0700 | [diff] [blame] | 635 | std::exit(EXIT_FAILURE); | 
| Patrick Venture | 11f1ff4 | 2019-08-01 10:42:12 -0700 | [diff] [blame] | 636 | } | 
|  | 637 |  | 
|  | 638 | // If buses field is missing, that's fine. | 
|  | 639 | if (data.count("buses") == 1) | 
|  | 640 | { | 
|  | 641 | // Parse the buses array after a little validation. | 
|  | 642 | auto buses = data.at("buses"); | 
|  | 643 | if (buses.type() != nlohmann::json::value_t::array) | 
|  | 644 | { | 
|  | 645 | // Buses field present but invalid, therefore this is an error. | 
| Matt Simmering | 2447c24 | 2023-11-09 14:18:39 -0800 | [diff] [blame] | 646 | std::cerr << "Invalid contents for blocklist buses field\n"; | 
| Patrick Venture | 11f1ff4 | 2019-08-01 10:42:12 -0700 | [diff] [blame] | 647 | std::exit(EXIT_FAILURE); | 
| Patrick Venture | 11f1ff4 | 2019-08-01 10:42:12 -0700 | [diff] [blame] | 648 | } | 
|  | 649 |  | 
|  | 650 | // Catch exception here for type mis-match. | 
|  | 651 | try | 
|  | 652 | { | 
| Bonnie Lo | bfda2c4 | 2022-10-26 16:50:54 +0800 | [diff] [blame] | 653 | for (const auto& busIterator : buses) | 
| Patrick Venture | 11f1ff4 | 2019-08-01 10:42:12 -0700 | [diff] [blame] | 654 | { | 
| Bonnie Lo | bfda2c4 | 2022-10-26 16:50:54 +0800 | [diff] [blame] | 655 | // If bus and addresses field are missing, that's fine. | 
|  | 656 | if (busIterator.contains("bus") && | 
|  | 657 | busIterator.contains("addresses")) | 
|  | 658 | { | 
|  | 659 | auto busData = busIterator.at("bus"); | 
|  | 660 | auto bus = busData.get<size_t>(); | 
|  | 661 |  | 
|  | 662 | auto addressData = busIterator.at("addresses"); | 
|  | 663 | auto addresses = | 
|  | 664 | addressData.get<std::set<std::string_view>>(); | 
|  | 665 |  | 
| Ed Tanous | fc17142 | 2024-04-04 17:18:16 -0700 | [diff] [blame] | 666 | auto& block = busBlocklist[bus].emplace(); | 
| Bonnie Lo | bfda2c4 | 2022-10-26 16:50:54 +0800 | [diff] [blame] | 667 | for (const auto& address : addresses) | 
|  | 668 | { | 
|  | 669 | size_t addressInt = 0; | 
| Alexander Hansen | 5df916f | 2025-09-26 10:31:36 -0400 | [diff] [blame] | 670 | bool fullMatch = false; | 
|  | 671 | fromCharsWrapper(address.substr(2), addressInt, | 
|  | 672 | fullMatch, 16); | 
| Ed Tanous | fc17142 | 2024-04-04 17:18:16 -0700 | [diff] [blame] | 673 | block.insert(addressInt); | 
| Bonnie Lo | bfda2c4 | 2022-10-26 16:50:54 +0800 | [diff] [blame] | 674 | } | 
|  | 675 | } | 
|  | 676 | else | 
|  | 677 | { | 
| Matt Simmering | 2447c24 | 2023-11-09 14:18:39 -0800 | [diff] [blame] | 678 | busBlocklist[busIterator.get<size_t>()] = std::nullopt; | 
| Bonnie Lo | bfda2c4 | 2022-10-26 16:50:54 +0800 | [diff] [blame] | 679 | } | 
| Patrick Venture | 11f1ff4 | 2019-08-01 10:42:12 -0700 | [diff] [blame] | 680 | } | 
|  | 681 | } | 
|  | 682 | catch (const nlohmann::detail::type_error& e) | 
|  | 683 | { | 
|  | 684 | // Type mis-match is a critical error. | 
|  | 685 | std::cerr << "Invalid bus type: " << e.what() << "\n"; | 
|  | 686 | std::exit(EXIT_FAILURE); | 
| Patrick Venture | 11f1ff4 | 2019-08-01 10:42:12 -0700 | [diff] [blame] | 687 | } | 
|  | 688 | } | 
| Patrick Venture | 11f1ff4 | 2019-08-01 10:42:12 -0700 | [diff] [blame] | 689 | } | 
|  | 690 |  | 
| Ed Tanous | 07d467b | 2021-02-23 14:48:37 -0800 | [diff] [blame] | 691 | static void findI2CDevices(const std::vector<fs::path>& i2cBuses, | 
| Jonathan Doman | 2418a61 | 2022-02-14 18:20:58 -0800 | [diff] [blame] | 692 | BusMap& busmap, const bool& powerIsOn, | 
| Kumar Thangavel | 7f43ea8 | 2021-12-07 17:20:16 +0530 | [diff] [blame] | 693 | sdbusplus::asio::object_server& objServer) | 
| James Feist | 3cb5fec | 2018-01-23 14:41:51 -0800 | [diff] [blame] | 694 | { | 
| Ed Tanous | 3013fb4 | 2022-07-09 08:27:06 -0700 | [diff] [blame] | 695 | for (const auto& i2cBus : i2cBuses) | 
| James Feist | 3cb5fec | 2018-01-23 14:41:51 -0800 | [diff] [blame] | 696 | { | 
| Ed Tanous | 3013fb4 | 2022-07-09 08:27:06 -0700 | [diff] [blame] | 697 | int bus = busStrToInt(i2cBus.string()); | 
| James Feist | 0c3980a | 2019-12-19 11:09:27 -0800 | [diff] [blame] | 698 |  | 
| James Feist | 5d7f469 | 2020-06-17 18:22:33 -0700 | [diff] [blame] | 699 | if (bus < 0) | 
|  | 700 | { | 
|  | 701 | std::cerr << "Cannot translate " << i2cBus << " to int\n"; | 
|  | 702 | continue; | 
|  | 703 | } | 
| Matt Simmering | 2447c24 | 2023-11-09 14:18:39 -0800 | [diff] [blame] | 704 | auto busFind = busBlocklist.find(bus); | 
|  | 705 | if (busFind != busBlocklist.end()) | 
| James Feist | 444830e | 2019-04-05 08:38:16 -0700 | [diff] [blame] | 706 | { | 
| Bonnie Lo | bfda2c4 | 2022-10-26 16:50:54 +0800 | [diff] [blame] | 707 | if (busFind->second == std::nullopt) | 
|  | 708 | { | 
|  | 709 | continue; // Skip blocked busses. | 
|  | 710 | } | 
| James Feist | 444830e | 2019-04-05 08:38:16 -0700 | [diff] [blame] | 711 | } | 
| James Feist | 0c3980a | 2019-12-19 11:09:27 -0800 | [diff] [blame] | 712 | int rootBus = getRootBus(bus); | 
| Matt Simmering | 2447c24 | 2023-11-09 14:18:39 -0800 | [diff] [blame] | 713 | auto rootBusFind = busBlocklist.find(rootBus); | 
|  | 714 | if (rootBusFind != busBlocklist.end()) | 
| James Feist | 0c3980a | 2019-12-19 11:09:27 -0800 | [diff] [blame] | 715 | { | 
| Bonnie Lo | bfda2c4 | 2022-10-26 16:50:54 +0800 | [diff] [blame] | 716 | if (rootBusFind->second == std::nullopt) | 
|  | 717 | { | 
|  | 718 | continue; | 
|  | 719 | } | 
| James Feist | 0c3980a | 2019-12-19 11:09:27 -0800 | [diff] [blame] | 720 | } | 
|  | 721 |  | 
| James Feist | 3cb5fec | 2018-01-23 14:41:51 -0800 | [diff] [blame] | 722 | auto file = open(i2cBus.c_str(), O_RDWR); | 
|  | 723 | if (file < 0) | 
|  | 724 | { | 
|  | 725 | std::cerr << "unable to open i2c device " << i2cBus.string() | 
|  | 726 | << "\n"; | 
|  | 727 | continue; | 
|  | 728 | } | 
|  | 729 | unsigned long funcs = 0; | 
|  | 730 |  | 
|  | 731 | if (ioctl(file, I2C_FUNCS, &funcs) < 0) | 
|  | 732 | { | 
|  | 733 | std::cerr | 
| Patrick Venture | 98e0cf3 | 2019-08-02 11:11:03 -0700 | [diff] [blame] | 734 | << "Error: Could not get the adapter functionality matrix bus " | 
| James Feist | 3cb5fec | 2018-01-23 14:41:51 -0800 | [diff] [blame] | 735 | << bus << "\n"; | 
| Zhikui Ren | c02d8cb | 2021-06-28 16:56:08 -0700 | [diff] [blame] | 736 | close(file); | 
| James Feist | 3cb5fec | 2018-01-23 14:41:51 -0800 | [diff] [blame] | 737 | continue; | 
|  | 738 | } | 
| Ed Tanous | 3013fb4 | 2022-07-09 08:27:06 -0700 | [diff] [blame] | 739 | if (((funcs & I2C_FUNC_SMBUS_READ_BYTE) == 0U) || | 
|  | 740 | ((I2C_FUNC_SMBUS_READ_I2C_BLOCK) == 0)) | 
| James Feist | 3cb5fec | 2018-01-23 14:41:51 -0800 | [diff] [blame] | 741 | { | 
|  | 742 | std::cerr << "Error: Can't use SMBus Receive Byte command bus " | 
|  | 743 | << bus << "\n"; | 
| George Liu | 913d07d | 2024-12-09 19:16:30 +0800 | [diff] [blame] | 744 | close(file); | 
| James Feist | 3cb5fec | 2018-01-23 14:41:51 -0800 | [diff] [blame] | 745 | continue; | 
|  | 746 | } | 
| James Feist | 9813279 | 2019-07-09 13:29:09 -0700 | [diff] [blame] | 747 | auto& device = busmap[bus]; | 
| James Feist | 3cb5fec | 2018-01-23 14:41:51 -0800 | [diff] [blame] | 748 | device = std::make_shared<DeviceMap>(); | 
|  | 749 |  | 
| Nikhil Potade | d8884f1 | 2019-03-27 13:27:13 -0700 | [diff] [blame] | 750 | //  i2cdetect by default uses the range 0x03 to 0x77, as | 
|  | 751 | //  this is  what we have tested with, use this range. Could be | 
|  | 752 | //  changed in future. | 
| Alexander Hansen | c3db2c3 | 2024-08-20 15:01:38 +0200 | [diff] [blame] | 753 | lg2::debug("Scanning bus {BUS}", "BUS", bus); | 
| Nikhil Potade | d8884f1 | 2019-03-27 13:27:13 -0700 | [diff] [blame] | 754 |  | 
|  | 755 | // fd is closed in this function in case the bus locks up | 
| Kumar Thangavel | 7f43ea8 | 2021-12-07 17:20:16 +0530 | [diff] [blame] | 756 | getBusFRUs(file, 0x03, 0x77, bus, device, powerIsOn, objServer); | 
| Nikhil Potade | d8884f1 | 2019-03-27 13:27:13 -0700 | [diff] [blame] | 757 |  | 
| Alexander Hansen | c3db2c3 | 2024-08-20 15:01:38 +0200 | [diff] [blame] | 758 | lg2::debug("Done scanning bus {BUS}", "BUS", bus); | 
| James Feist | 3cb5fec | 2018-01-23 14:41:51 -0800 | [diff] [blame] | 759 | } | 
| James Feist | 3cb5fec | 2018-01-23 14:41:51 -0800 | [diff] [blame] | 760 | } | 
|  | 761 |  | 
| James Feist | 6ebf9de | 2018-05-15 15:01:17 -0700 | [diff] [blame] | 762 | // this class allows an async response after all i2c devices are discovered | 
| James Feist | 8c505da | 2020-05-28 10:06:33 -0700 | [diff] [blame] | 763 | struct FindDevicesWithCallback : | 
|  | 764 | std::enable_shared_from_this<FindDevicesWithCallback> | 
| James Feist | 6ebf9de | 2018-05-15 15:01:17 -0700 | [diff] [blame] | 765 | { | 
| James Feist | a465ccc | 2019-02-08 12:51:01 -0800 | [diff] [blame] | 766 | FindDevicesWithCallback(const std::vector<fs::path>& i2cBuses, | 
| Jonathan Doman | 2418a61 | 2022-02-14 18:20:58 -0800 | [diff] [blame] | 767 | BusMap& busmap, const bool& powerIsOn, | 
| Kumar Thangavel | 7f43ea8 | 2021-12-07 17:20:16 +0530 | [diff] [blame] | 768 | sdbusplus::asio::object_server& objServer, | 
| Delphine CC Chiu | a3ca14a | 2024-03-27 17:02:24 +0800 | [diff] [blame] | 769 | std::function<void()>&& callback) : | 
| Patrick Williams | b707743 | 2024-08-16 15:22:21 -0400 | [diff] [blame] | 770 | _i2cBuses(i2cBuses), _busMap(busmap), _powerIsOn(powerIsOn), | 
|  | 771 | _objServer(objServer), _callback(std::move(callback)) | 
| James Feist | 8c505da | 2020-05-28 10:06:33 -0700 | [diff] [blame] | 772 | {} | 
| James Feist | 6ebf9de | 2018-05-15 15:01:17 -0700 | [diff] [blame] | 773 | ~FindDevicesWithCallback() | 
|  | 774 | { | 
|  | 775 | _callback(); | 
|  | 776 | } | 
|  | 777 | void run() | 
|  | 778 | { | 
| Kumar Thangavel | 7f43ea8 | 2021-12-07 17:20:16 +0530 | [diff] [blame] | 779 | findI2CDevices(_i2cBuses, _busMap, _powerIsOn, _objServer); | 
| James Feist | 6ebf9de | 2018-05-15 15:01:17 -0700 | [diff] [blame] | 780 | } | 
|  | 781 |  | 
| James Feist | a465ccc | 2019-02-08 12:51:01 -0800 | [diff] [blame] | 782 | const std::vector<fs::path>& _i2cBuses; | 
| James Feist | a465ccc | 2019-02-08 12:51:01 -0800 | [diff] [blame] | 783 | BusMap& _busMap; | 
| Jonathan Doman | 2418a61 | 2022-02-14 18:20:58 -0800 | [diff] [blame] | 784 | const bool& _powerIsOn; | 
| Kumar Thangavel | 7f43ea8 | 2021-12-07 17:20:16 +0530 | [diff] [blame] | 785 | sdbusplus::asio::object_server& _objServer; | 
| Delphine CC Chiu | a3ca14a | 2024-03-27 17:02:24 +0800 | [diff] [blame] | 786 | std::function<void()> _callback; | 
| James Feist | 6ebf9de | 2018-05-15 15:01:17 -0700 | [diff] [blame] | 787 | }; | 
|  | 788 |  | 
| Ed Tanous | 07d467b | 2021-02-23 14:48:37 -0800 | [diff] [blame] | 789 | void addFruObjectToDbus( | 
| Andrei Kartashev | 1c5b706 | 2020-08-19 14:47:30 +0300 | [diff] [blame] | 790 | std::vector<uint8_t>& device, | 
| James Feist | a465ccc | 2019-02-08 12:51:01 -0800 | [diff] [blame] | 791 | boost::container::flat_map< | 
|  | 792 | std::pair<size_t, size_t>, | 
|  | 793 | std::shared_ptr<sdbusplus::asio::dbus_interface>>& dbusInterfaceMap, | 
| Kumar Thangavel | 1e8e71f | 2021-12-01 19:39:11 +0530 | [diff] [blame] | 794 | uint32_t bus, uint32_t address, size_t& unknownBusObjectCount, | 
| Sora Su | 12e2d41 | 2025-08-22 14:23:16 +0800 | [diff] [blame] | 795 | const bool& powerIsOn, sdbusplus::asio::object_server& objServer) | 
| James Feist | 3cb5fec | 2018-01-23 14:41:51 -0800 | [diff] [blame] | 796 | { | 
| Andrei Kartashev | 2f0de17 | 2020-08-13 14:29:40 +0300 | [diff] [blame] | 797 | boost::container::flat_map<std::string, std::string> formattedFRU; | 
| Kumar Thangavel | 9f2162a | 2022-08-10 18:05:20 +0530 | [diff] [blame] | 798 |  | 
|  | 799 | std::optional<std::string> optionalProductName = getProductName( | 
|  | 800 | device, formattedFRU, bus, address, unknownBusObjectCount); | 
|  | 801 | if (!optionalProductName) | 
| James Feist | 3cb5fec | 2018-01-23 14:41:51 -0800 | [diff] [blame] | 802 | { | 
| Kumar Thangavel | 9f2162a | 2022-08-10 18:05:20 +0530 | [diff] [blame] | 803 | std::cerr << "getProductName failed. product name is empty.\n"; | 
| James Feist | 3cb5fec | 2018-01-23 14:41:51 -0800 | [diff] [blame] | 804 | return; | 
|  | 805 | } | 
| Patrick Venture | 96cdaef | 2019-07-30 13:30:52 -0700 | [diff] [blame] | 806 |  | 
| Patrick Williams | b707743 | 2024-08-16 15:22:21 -0400 | [diff] [blame] | 807 | std::string productName = | 
|  | 808 | "/xyz/openbmc_project/FruDevice/" + optionalProductName.value(); | 
| James Feist | 3cb5fec | 2018-01-23 14:41:51 -0800 | [diff] [blame] | 809 |  | 
| Kumar Thangavel | d79d025 | 2022-08-24 14:26:01 +0530 | [diff] [blame] | 810 | std::optional<int> index = findIndexForFRU(dbusInterfaceMap, productName); | 
|  | 811 | if (index.has_value()) | 
| James Feist | 918e18c | 2018-02-13 15:51:07 -0800 | [diff] [blame] | 812 | { | 
| Kumar Thangavel | d79d025 | 2022-08-24 14:26:01 +0530 | [diff] [blame] | 813 | productName += "_"; | 
|  | 814 | productName += std::to_string(++(*index)); | 
| James Feist | 918e18c | 2018-02-13 15:51:07 -0800 | [diff] [blame] | 815 | } | 
| James Feist | 3cb5fec | 2018-01-23 14:41:51 -0800 | [diff] [blame] | 816 |  | 
| James Feist | 9eb0b58 | 2018-04-27 12:15:46 -0700 | [diff] [blame] | 817 | std::shared_ptr<sdbusplus::asio::dbus_interface> iface = | 
|  | 818 | objServer.add_interface(productName, "xyz.openbmc_project.FruDevice"); | 
|  | 819 | dbusInterfaceMap[std::pair<size_t, size_t>(bus, address)] = iface; | 
|  | 820 |  | 
| Naresh Solanki | cf28896 | 2025-06-06 15:26:11 +0530 | [diff] [blame] | 821 | if (ENABLE_FRU_UPDATE_PROPERTY) | 
|  | 822 | { | 
|  | 823 | iface->register_method( | 
|  | 824 | "UpdateFruField", | 
|  | 825 | [bus, address, &dbusInterfaceMap, &unknownBusObjectCount, | 
|  | 826 | &powerIsOn, &objServer](const std::string& fieldName, | 
|  | 827 | const std::string& fieldValue) { | 
|  | 828 | // Update the property | 
|  | 829 | if (!updateFruProperty(fieldValue, bus, address, fieldName, | 
|  | 830 | dbusInterfaceMap, unknownBusObjectCount, | 
|  | 831 | powerIsOn, objServer)) | 
|  | 832 | { | 
|  | 833 | lg2::debug( | 
|  | 834 | "Failed to Add Field: Name = {NAME}, Value = {VALUE}", | 
|  | 835 | "NAME", fieldName, "VALUE", fieldValue); | 
|  | 836 | return false; | 
|  | 837 | } | 
|  | 838 |  | 
|  | 839 | return true; | 
|  | 840 | }); | 
|  | 841 | } | 
|  | 842 |  | 
| Andrei Kartashev | 2f0de17 | 2020-08-13 14:29:40 +0300 | [diff] [blame] | 843 | for (auto& property : formattedFRU) | 
| James Feist | 3cb5fec | 2018-01-23 14:41:51 -0800 | [diff] [blame] | 844 | { | 
| Jae Hyun Yoo | 3936e7a | 2018-03-23 17:26:16 -0700 | [diff] [blame] | 845 | std::regex_replace(property.second.begin(), property.second.begin(), | 
| Ed Tanous | 07d467b | 2021-02-23 14:48:37 -0800 | [diff] [blame] | 846 | property.second.end(), nonAsciiRegex, "_"); | 
| Naresh Solanki | 89092a9 | 2025-06-02 15:48:04 +0530 | [diff] [blame] | 847 | if (property.second.empty()) | 
| James Feist | 9eb0b58 | 2018-04-27 12:15:46 -0700 | [diff] [blame] | 848 | { | 
|  | 849 | continue; | 
|  | 850 | } | 
| Patrick Williams | b707743 | 2024-08-16 15:22:21 -0400 | [diff] [blame] | 851 | std::string key = | 
|  | 852 | std::regex_replace(property.first, nonAsciiRegex, "_"); | 
| Joshi-Mansi | d73b744 | 2020-03-27 19:10:21 +0530 | [diff] [blame] | 853 |  | 
| Naresh Solanki | 89092a9 | 2025-06-02 15:48:04 +0530 | [diff] [blame] | 854 | // Allow FRU field update if ENABLE_FRU_UPDATE_PROPERTY is set. | 
|  | 855 | if (isFieldEditable(property.first)) | 
| Joshi-Mansi | d73b744 | 2020-03-27 19:10:21 +0530 | [diff] [blame] | 856 | { | 
|  | 857 | std::string propertyName = property.first; | 
|  | 858 | iface->register_property( | 
|  | 859 | key, property.second + '\0', | 
| Kumar Thangavel | 41a9051 | 2021-11-24 15:44:20 +0530 | [diff] [blame] | 860 | [bus, address, propertyName, &dbusInterfaceMap, | 
| Sora Su | 12e2d41 | 2025-08-22 14:23:16 +0800 | [diff] [blame] | 861 | &unknownBusObjectCount, &powerIsOn, | 
|  | 862 | &objServer](const std::string& req, std::string& resp) { | 
| Patrick Williams | b707743 | 2024-08-16 15:22:21 -0400 | [diff] [blame] | 863 | if (strcmp(req.c_str(), resp.c_str()) != 0) | 
| Joshi-Mansi | d73b744 | 2020-03-27 19:10:21 +0530 | [diff] [blame] | 864 | { | 
| Patrick Williams | b707743 | 2024-08-16 15:22:21 -0400 | [diff] [blame] | 865 | // call the method which will update | 
| Naresh Solanki | cf28896 | 2025-06-06 15:26:11 +0530 | [diff] [blame] | 866 | if (updateFruProperty(req, bus, address, propertyName, | 
| Patrick Williams | b707743 | 2024-08-16 15:22:21 -0400 | [diff] [blame] | 867 | dbusInterfaceMap, | 
|  | 868 | unknownBusObjectCount, powerIsOn, | 
| Sora Su | 12e2d41 | 2025-08-22 14:23:16 +0800 | [diff] [blame] | 869 | objServer)) | 
| Patrick Williams | b707743 | 2024-08-16 15:22:21 -0400 | [diff] [blame] | 870 | { | 
|  | 871 | resp = req; | 
|  | 872 | } | 
|  | 873 | else | 
|  | 874 | { | 
|  | 875 | throw std::invalid_argument( | 
|  | 876 | "FRU property update failed."); | 
|  | 877 | } | 
| Joshi-Mansi | d73b744 | 2020-03-27 19:10:21 +0530 | [diff] [blame] | 878 | } | 
| Patrick Williams | b707743 | 2024-08-16 15:22:21 -0400 | [diff] [blame] | 879 | return 1; | 
|  | 880 | }); | 
| Joshi-Mansi | d73b744 | 2020-03-27 19:10:21 +0530 | [diff] [blame] | 881 | } | 
|  | 882 | else if (!iface->register_property(key, property.second + '\0')) | 
| James Feist | 9eb0b58 | 2018-04-27 12:15:46 -0700 | [diff] [blame] | 883 | { | 
|  | 884 | std::cerr << "illegal key: " << key << "\n"; | 
|  | 885 | } | 
| Alexander Hansen | c3db2c3 | 2024-08-20 15:01:38 +0200 | [diff] [blame] | 886 | lg2::debug("parsed FRU property: {FIRST}: {SECOND}", "FIRST", | 
|  | 887 | property.first, "SECOND", property.second); | 
| James Feist | 3cb5fec | 2018-01-23 14:41:51 -0800 | [diff] [blame] | 888 | } | 
| James Feist | 2a9d6db | 2018-04-27 15:48:28 -0700 | [diff] [blame] | 889 |  | 
|  | 890 | // baseboard will be 0, 0 | 
| James Feist | 13b86d6 | 2018-05-29 11:24:35 -0700 | [diff] [blame] | 891 | iface->register_property("BUS", bus); | 
|  | 892 | iface->register_property("ADDRESS", address); | 
| James Feist | 2a9d6db | 2018-04-27 15:48:28 -0700 | [diff] [blame] | 893 |  | 
| James Feist | 9eb0b58 | 2018-04-27 12:15:46 -0700 | [diff] [blame] | 894 | iface->initialize(); | 
| James Feist | 3cb5fec | 2018-01-23 14:41:51 -0800 | [diff] [blame] | 895 | } | 
|  | 896 |  | 
| Andrei Kartashev | 2f0de17 | 2020-08-13 14:29:40 +0300 | [diff] [blame] | 897 | static bool readBaseboardFRU(std::vector<uint8_t>& baseboardFRU) | 
| James Feist | 3cb5fec | 2018-01-23 14:41:51 -0800 | [diff] [blame] | 898 | { | 
|  | 899 | // try to read baseboard fru from file | 
| Ed Tanous | 07d467b | 2021-02-23 14:48:37 -0800 | [diff] [blame] | 900 | std::ifstream baseboardFRUFile(baseboardFruLocation, std::ios::binary); | 
| Andrei Kartashev | 2f0de17 | 2020-08-13 14:29:40 +0300 | [diff] [blame] | 901 | if (baseboardFRUFile.good()) | 
| James Feist | 3cb5fec | 2018-01-23 14:41:51 -0800 | [diff] [blame] | 902 | { | 
| Andrei Kartashev | 2f0de17 | 2020-08-13 14:29:40 +0300 | [diff] [blame] | 903 | baseboardFRUFile.seekg(0, std::ios_base::end); | 
|  | 904 | size_t fileSize = static_cast<size_t>(baseboardFRUFile.tellg()); | 
|  | 905 | baseboardFRU.resize(fileSize); | 
|  | 906 | baseboardFRUFile.seekg(0, std::ios_base::beg); | 
| Ed Tanous | 3013fb4 | 2022-07-09 08:27:06 -0700 | [diff] [blame] | 907 | // NOLINTNEXTLINE(cppcoreguidelines-pro-type-reinterpret-cast) | 
|  | 908 | char* charOffset = reinterpret_cast<char*>(baseboardFRU.data()); | 
|  | 909 | baseboardFRUFile.read(charOffset, fileSize); | 
| James Feist | 3cb5fec | 2018-01-23 14:41:51 -0800 | [diff] [blame] | 910 | } | 
|  | 911 | else | 
|  | 912 | { | 
|  | 913 | return false; | 
|  | 914 | } | 
|  | 915 | return true; | 
|  | 916 | } | 
|  | 917 |  | 
| Andrei Kartashev | 2f0de17 | 2020-08-13 14:29:40 +0300 | [diff] [blame] | 918 | bool writeFRU(uint8_t bus, uint8_t address, const std::vector<uint8_t>& fru) | 
| James Feist | b49ffc3 | 2018-05-02 11:10:43 -0700 | [diff] [blame] | 919 | { | 
|  | 920 | boost::container::flat_map<std::string, std::string> tmp; | 
| Ed Tanous | 07d467b | 2021-02-23 14:48:37 -0800 | [diff] [blame] | 921 | if (fru.size() > maxFruSize) | 
| James Feist | b49ffc3 | 2018-05-02 11:10:43 -0700 | [diff] [blame] | 922 | { | 
| Andrei Kartashev | 2f0de17 | 2020-08-13 14:29:40 +0300 | [diff] [blame] | 923 | std::cerr << "Invalid fru.size() during writeFRU\n"; | 
| James Feist | b49ffc3 | 2018-05-02 11:10:43 -0700 | [diff] [blame] | 924 | return false; | 
|  | 925 | } | 
|  | 926 | // verify legal fru by running it through fru parsing logic | 
| Michael Shen | 0961b11 | 2022-02-22 11:06:33 +0800 | [diff] [blame] | 927 | if (formatIPMIFRU(fru, tmp) != resCodes::resOK) | 
| James Feist | b49ffc3 | 2018-05-02 11:10:43 -0700 | [diff] [blame] | 928 | { | 
| Andrei Kartashev | 2f0de17 | 2020-08-13 14:29:40 +0300 | [diff] [blame] | 929 | std::cerr << "Invalid fru format during writeFRU\n"; | 
| James Feist | b49ffc3 | 2018-05-02 11:10:43 -0700 | [diff] [blame] | 930 | return false; | 
|  | 931 | } | 
|  | 932 | // baseboard fru | 
|  | 933 | if (bus == 0 && address == 0) | 
|  | 934 | { | 
| Ed Tanous | 07d467b | 2021-02-23 14:48:37 -0800 | [diff] [blame] | 935 | std::ofstream file(baseboardFruLocation, std::ios_base::binary); | 
| James Feist | b49ffc3 | 2018-05-02 11:10:43 -0700 | [diff] [blame] | 936 | if (!file.good()) | 
|  | 937 | { | 
| Ed Tanous | 07d467b | 2021-02-23 14:48:37 -0800 | [diff] [blame] | 938 | std::cerr << "Error opening file " << baseboardFruLocation << "\n"; | 
| James Feist | ddb7830 | 2018-09-06 11:45:42 -0700 | [diff] [blame] | 939 | throw DBusInternalError(); | 
| James Feist | b49ffc3 | 2018-05-02 11:10:43 -0700 | [diff] [blame] | 940 | return false; | 
|  | 941 | } | 
| Ed Tanous | 3013fb4 | 2022-07-09 08:27:06 -0700 | [diff] [blame] | 942 | // NOLINTNEXTLINE(cppcoreguidelines-pro-type-reinterpret-cast) | 
|  | 943 | const char* charOffset = reinterpret_cast<const char*>(fru.data()); | 
|  | 944 | file.write(charOffset, fru.size()); | 
| James Feist | b49ffc3 | 2018-05-02 11:10:43 -0700 | [diff] [blame] | 945 | return file.good(); | 
|  | 946 | } | 
| Ed Tanous | 07d467b | 2021-02-23 14:48:37 -0800 | [diff] [blame] | 947 |  | 
|  | 948 | if (hasEepromFile(bus, address)) | 
| James Feist | b49ffc3 | 2018-05-02 11:10:43 -0700 | [diff] [blame] | 949 | { | 
| Ed Tanous | 07d467b | 2021-02-23 14:48:37 -0800 | [diff] [blame] | 950 | auto path = getEepromPath(bus, address); | 
| Naresh Solanki | 41ee180 | 2024-11-09 01:44:46 +0530 | [diff] [blame] | 951 | off_t offset = 0; | 
|  | 952 |  | 
| Ed Tanous | 07d467b | 2021-02-23 14:48:37 -0800 | [diff] [blame] | 953 | int eeprom = open(path.c_str(), O_RDWR | O_CLOEXEC); | 
|  | 954 | if (eeprom < 0) | 
| Patrick Venture | c50e1ff | 2019-08-06 10:22:28 -0700 | [diff] [blame] | 955 | { | 
| Ed Tanous | 07d467b | 2021-02-23 14:48:37 -0800 | [diff] [blame] | 956 | std::cerr << "unable to open i2c device " << path << "\n"; | 
|  | 957 | throw DBusInternalError(); | 
|  | 958 | return false; | 
|  | 959 | } | 
| Patrick Venture | c50e1ff | 2019-08-06 10:22:28 -0700 | [diff] [blame] | 960 |  | 
| Naresh Solanki | 41ee180 | 2024-11-09 01:44:46 +0530 | [diff] [blame] | 961 | std::array<uint8_t, I2C_SMBUS_BLOCK_MAX> blockData{}; | 
|  | 962 | std::string errorMessage = "eeprom at " + std::to_string(bus) + | 
|  | 963 | " address " + std::to_string(address); | 
|  | 964 | auto readFunc = [eeprom](off_t offset, size_t length, uint8_t* outbuf) { | 
|  | 965 | return readFromEeprom(eeprom, offset, length, outbuf); | 
|  | 966 | }; | 
|  | 967 | FRUReader reader(std::move(readFunc)); | 
|  | 968 |  | 
|  | 969 | if (!findFRUHeader(reader, errorMessage, blockData, offset)) | 
|  | 970 | { | 
|  | 971 | offset = 0; | 
|  | 972 | } | 
|  | 973 |  | 
|  | 974 | if (lseek(eeprom, offset, SEEK_SET) < 0) | 
|  | 975 | { | 
|  | 976 | std::cerr << "Unable to seek to offset " << offset | 
|  | 977 | << " in device: " << path << "\n"; | 
|  | 978 | close(eeprom); | 
|  | 979 | throw DBusInternalError(); | 
|  | 980 | } | 
|  | 981 |  | 
| Ed Tanous | 07d467b | 2021-02-23 14:48:37 -0800 | [diff] [blame] | 982 | ssize_t writtenBytes = write(eeprom, fru.data(), fru.size()); | 
|  | 983 | if (writtenBytes < 0) | 
|  | 984 | { | 
|  | 985 | std::cerr << "unable to write to i2c device " << path << "\n"; | 
| Patrick Venture | c50e1ff | 2019-08-06 10:22:28 -0700 | [diff] [blame] | 986 | close(eeprom); | 
| James Feist | ddb7830 | 2018-09-06 11:45:42 -0700 | [diff] [blame] | 987 | throw DBusInternalError(); | 
| James Feist | b49ffc3 | 2018-05-02 11:10:43 -0700 | [diff] [blame] | 988 | return false; | 
|  | 989 | } | 
|  | 990 |  | 
| Ed Tanous | 07d467b | 2021-02-23 14:48:37 -0800 | [diff] [blame] | 991 | close(eeprom); | 
| James Feist | b49ffc3 | 2018-05-02 11:10:43 -0700 | [diff] [blame] | 992 | return true; | 
|  | 993 | } | 
| Ed Tanous | 07d467b | 2021-02-23 14:48:37 -0800 | [diff] [blame] | 994 |  | 
|  | 995 | std::string i2cBus = "/dev/i2c-" + std::to_string(bus); | 
|  | 996 |  | 
|  | 997 | int file = open(i2cBus.c_str(), O_RDWR | O_CLOEXEC); | 
|  | 998 | if (file < 0) | 
|  | 999 | { | 
|  | 1000 | std::cerr << "unable to open i2c device " << i2cBus << "\n"; | 
|  | 1001 | throw DBusInternalError(); | 
|  | 1002 | return false; | 
|  | 1003 | } | 
|  | 1004 | if (ioctl(file, I2C_SLAVE_FORCE, address) < 0) | 
|  | 1005 | { | 
|  | 1006 | std::cerr << "unable to set device address\n"; | 
|  | 1007 | close(file); | 
|  | 1008 | throw DBusInternalError(); | 
|  | 1009 | return false; | 
|  | 1010 | } | 
|  | 1011 |  | 
|  | 1012 | constexpr const size_t retryMax = 2; | 
|  | 1013 | uint16_t index = 0; | 
|  | 1014 | size_t retries = retryMax; | 
|  | 1015 | while (index < fru.size()) | 
|  | 1016 | { | 
| Ed Tanous | 3013fb4 | 2022-07-09 08:27:06 -0700 | [diff] [blame] | 1017 | if (((index != 0U) && ((index % (maxEepromPageIndex + 1)) == 0)) && | 
| Ed Tanous | 07d467b | 2021-02-23 14:48:37 -0800 | [diff] [blame] | 1018 | (retries == retryMax)) | 
|  | 1019 | { | 
|  | 1020 | // The 4K EEPROM only uses the A2 and A1 device address bits | 
|  | 1021 | // with the third bit being a memory page address bit. | 
|  | 1022 | if (ioctl(file, I2C_SLAVE_FORCE, ++address) < 0) | 
|  | 1023 | { | 
|  | 1024 | std::cerr << "unable to set device address\n"; | 
|  | 1025 | close(file); | 
|  | 1026 | throw DBusInternalError(); | 
|  | 1027 | return false; | 
|  | 1028 | } | 
|  | 1029 | } | 
|  | 1030 |  | 
|  | 1031 | if (i2c_smbus_write_byte_data(file, static_cast<uint8_t>(index), | 
|  | 1032 | fru[index]) < 0) | 
|  | 1033 | { | 
| Ed Tanous | 3013fb4 | 2022-07-09 08:27:06 -0700 | [diff] [blame] | 1034 | if ((retries--) == 0U) | 
| Ed Tanous | 07d467b | 2021-02-23 14:48:37 -0800 | [diff] [blame] | 1035 | { | 
|  | 1036 | std::cerr << "error writing fru: " << strerror(errno) << "\n"; | 
|  | 1037 | close(file); | 
|  | 1038 | throw DBusInternalError(); | 
|  | 1039 | return false; | 
|  | 1040 | } | 
|  | 1041 | } | 
|  | 1042 | else | 
|  | 1043 | { | 
|  | 1044 | retries = retryMax; | 
|  | 1045 | index++; | 
|  | 1046 | } | 
|  | 1047 | // most eeproms require 5-10ms between writes | 
|  | 1048 | std::this_thread::sleep_for(std::chrono::milliseconds(10)); | 
|  | 1049 | } | 
|  | 1050 | close(file); | 
|  | 1051 | return true; | 
| James Feist | b49ffc3 | 2018-05-02 11:10:43 -0700 | [diff] [blame] | 1052 | } | 
|  | 1053 |  | 
| Cheng C Yang | d5b87fb | 2020-01-23 10:10:45 +0800 | [diff] [blame] | 1054 | void rescanOneBus( | 
| krishnar4 | 213ee21 | 2022-11-11 15:39:30 +0530 | [diff] [blame] | 1055 | BusMap& busmap, uint16_t busNum, | 
| Cheng C Yang | d5b87fb | 2020-01-23 10:10:45 +0800 | [diff] [blame] | 1056 | boost::container::flat_map< | 
|  | 1057 | std::pair<size_t, size_t>, | 
| James Feist | 5d7f469 | 2020-06-17 18:22:33 -0700 | [diff] [blame] | 1058 | std::shared_ptr<sdbusplus::asio::dbus_interface>>& dbusInterfaceMap, | 
| Jonathan Doman | 2418a61 | 2022-02-14 18:20:58 -0800 | [diff] [blame] | 1059 | bool dbusCall, size_t& unknownBusObjectCount, const bool& powerIsOn, | 
| Sora Su | 12e2d41 | 2025-08-22 14:23:16 +0800 | [diff] [blame] | 1060 | sdbusplus::asio::object_server& objServer) | 
| Cheng C Yang | d5b87fb | 2020-01-23 10:10:45 +0800 | [diff] [blame] | 1061 | { | 
| Yong Li | 6fdfac0 | 2023-10-30 11:21:30 +0800 | [diff] [blame] | 1062 | for (auto device = foundDevices.begin(); device != foundDevices.end();) | 
| Cheng C Yang | d5b87fb | 2020-01-23 10:10:45 +0800 | [diff] [blame] | 1063 | { | 
| Yong Li | 6fdfac0 | 2023-10-30 11:21:30 +0800 | [diff] [blame] | 1064 | if (device->first.first == static_cast<size_t>(busNum)) | 
| Cheng C Yang | d5b87fb | 2020-01-23 10:10:45 +0800 | [diff] [blame] | 1065 | { | 
| Yong Li | 6fdfac0 | 2023-10-30 11:21:30 +0800 | [diff] [blame] | 1066 | objServer.remove_interface(device->second); | 
|  | 1067 | device = foundDevices.erase(device); | 
|  | 1068 | } | 
|  | 1069 | else | 
|  | 1070 | { | 
|  | 1071 | device++; | 
| Cheng C Yang | d5b87fb | 2020-01-23 10:10:45 +0800 | [diff] [blame] | 1072 | } | 
|  | 1073 | } | 
|  | 1074 |  | 
| James Feist | 5d7f469 | 2020-06-17 18:22:33 -0700 | [diff] [blame] | 1075 | fs::path busPath = fs::path("/dev/i2c-" + std::to_string(busNum)); | 
|  | 1076 | if (!fs::exists(busPath)) | 
|  | 1077 | { | 
|  | 1078 | if (dbusCall) | 
|  | 1079 | { | 
|  | 1080 | std::cerr << "Unable to access i2c bus " << static_cast<int>(busNum) | 
|  | 1081 | << "\n"; | 
|  | 1082 | throw std::invalid_argument("Invalid Bus."); | 
|  | 1083 | } | 
|  | 1084 | return; | 
|  | 1085 | } | 
|  | 1086 |  | 
|  | 1087 | std::vector<fs::path> i2cBuses; | 
|  | 1088 | i2cBuses.emplace_back(busPath); | 
|  | 1089 |  | 
| Cheng C Yang | d5b87fb | 2020-01-23 10:10:45 +0800 | [diff] [blame] | 1090 | auto scan = std::make_shared<FindDevicesWithCallback>( | 
| Kumar Thangavel | 7f43ea8 | 2021-12-07 17:20:16 +0530 | [diff] [blame] | 1091 | i2cBuses, busmap, powerIsOn, objServer, | 
|  | 1092 | [busNum, &busmap, &dbusInterfaceMap, &unknownBusObjectCount, &powerIsOn, | 
| Sora Su | 12e2d41 | 2025-08-22 14:23:16 +0800 | [diff] [blame] | 1093 | &objServer]() { | 
| Patrick Williams | b707743 | 2024-08-16 15:22:21 -0400 | [diff] [blame] | 1094 | for (auto busIface = dbusInterfaceMap.begin(); | 
|  | 1095 | busIface != dbusInterfaceMap.end();) | 
| Cheng C Yang | d5b87fb | 2020-01-23 10:10:45 +0800 | [diff] [blame] | 1096 | { | 
| Patrick Williams | b707743 | 2024-08-16 15:22:21 -0400 | [diff] [blame] | 1097 | if (busIface->first.first == static_cast<size_t>(busNum)) | 
|  | 1098 | { | 
|  | 1099 | objServer.remove_interface(busIface->second); | 
|  | 1100 | busIface = dbusInterfaceMap.erase(busIface); | 
|  | 1101 | } | 
|  | 1102 | else | 
|  | 1103 | { | 
|  | 1104 | busIface++; | 
|  | 1105 | } | 
| Yong Li | 6fdfac0 | 2023-10-30 11:21:30 +0800 | [diff] [blame] | 1106 | } | 
| Patrick Williams | b707743 | 2024-08-16 15:22:21 -0400 | [diff] [blame] | 1107 | auto found = busmap.find(busNum); | 
|  | 1108 | if (found == busmap.end() || found->second == nullptr) | 
| Yong Li | 6fdfac0 | 2023-10-30 11:21:30 +0800 | [diff] [blame] | 1109 | { | 
| Patrick Williams | b707743 | 2024-08-16 15:22:21 -0400 | [diff] [blame] | 1110 | return; | 
| Cheng C Yang | d5b87fb | 2020-01-23 10:10:45 +0800 | [diff] [blame] | 1111 | } | 
| Patrick Williams | b707743 | 2024-08-16 15:22:21 -0400 | [diff] [blame] | 1112 | for (auto& device : *(found->second)) | 
|  | 1113 | { | 
|  | 1114 | addFruObjectToDbus(device.second, dbusInterfaceMap, | 
|  | 1115 | static_cast<uint32_t>(busNum), device.first, | 
| Sora Su | 12e2d41 | 2025-08-22 14:23:16 +0800 | [diff] [blame] | 1116 | unknownBusObjectCount, powerIsOn, objServer); | 
| Patrick Williams | b707743 | 2024-08-16 15:22:21 -0400 | [diff] [blame] | 1117 | } | 
|  | 1118 | }); | 
| Cheng C Yang | d5b87fb | 2020-01-23 10:10:45 +0800 | [diff] [blame] | 1119 | scan->run(); | 
|  | 1120 | } | 
|  | 1121 |  | 
| James Feist | 9eb0b58 | 2018-04-27 12:15:46 -0700 | [diff] [blame] | 1122 | void rescanBusses( | 
| James Feist | 5cb0608 | 2019-10-24 17:11:13 -0700 | [diff] [blame] | 1123 | BusMap& busmap, | 
| James Feist | a465ccc | 2019-02-08 12:51:01 -0800 | [diff] [blame] | 1124 | boost::container::flat_map< | 
|  | 1125 | std::pair<size_t, size_t>, | 
| Kumar Thangavel | 41a9051 | 2021-11-24 15:44:20 +0530 | [diff] [blame] | 1126 | std::shared_ptr<sdbusplus::asio::dbus_interface>>& dbusInterfaceMap, | 
| Jonathan Doman | 2418a61 | 2022-02-14 18:20:58 -0800 | [diff] [blame] | 1127 | size_t& unknownBusObjectCount, const bool& powerIsOn, | 
| Sora Su | 12e2d41 | 2025-08-22 14:23:16 +0800 | [diff] [blame] | 1128 | sdbusplus::asio::object_server& objServer) | 
| James Feist | 918e18c | 2018-02-13 15:51:07 -0800 | [diff] [blame] | 1129 | { | 
| Ed Tanous | aa497ed | 2023-02-28 13:43:41 -0800 | [diff] [blame] | 1130 | static boost::asio::steady_timer timer(io); | 
| Ed Tanous | ae2d435 | 2025-02-12 15:51:48 -0800 | [diff] [blame] | 1131 | timer.expires_after(std::chrono::seconds(1)); | 
| James Feist | 918e18c | 2018-02-13 15:51:07 -0800 | [diff] [blame] | 1132 |  | 
| Gunnar Mills | 6f0ae94 | 2018-08-31 12:38:03 -0500 | [diff] [blame] | 1133 | // setup an async wait in case we get flooded with requests | 
| Jian Zhang | 6e7cebf | 2022-11-29 18:30:21 +0800 | [diff] [blame] | 1134 | timer.async_wait([&](const boost::system::error_code& ec) { | 
|  | 1135 | if (ec == boost::asio::error::operation_aborted) | 
|  | 1136 | { | 
|  | 1137 | return; | 
|  | 1138 | } | 
|  | 1139 |  | 
|  | 1140 | if (ec) | 
|  | 1141 | { | 
|  | 1142 | std::cerr << "Error in timer: " << ec.message() << "\n"; | 
|  | 1143 | return; | 
|  | 1144 | } | 
|  | 1145 |  | 
| James Feist | 4131aea | 2018-03-09 09:47:30 -0800 | [diff] [blame] | 1146 | auto devDir = fs::path("/dev/"); | 
| James Feist | 4131aea | 2018-03-09 09:47:30 -0800 | [diff] [blame] | 1147 | std::vector<fs::path> i2cBuses; | 
| James Feist | 918e18c | 2018-02-13 15:51:07 -0800 | [diff] [blame] | 1148 |  | 
| Nikhil Potade | d8884f1 | 2019-03-27 13:27:13 -0700 | [diff] [blame] | 1149 | boost::container::flat_map<size_t, fs::path> busPaths; | 
|  | 1150 | if (!getI2cDevicePaths(devDir, busPaths)) | 
| James Feist | 918e18c | 2018-02-13 15:51:07 -0800 | [diff] [blame] | 1151 | { | 
| James Feist | 4131aea | 2018-03-09 09:47:30 -0800 | [diff] [blame] | 1152 | std::cerr << "unable to find i2c devices\n"; | 
|  | 1153 | return; | 
| James Feist | 918e18c | 2018-02-13 15:51:07 -0800 | [diff] [blame] | 1154 | } | 
| Nikhil Potade | d8884f1 | 2019-03-27 13:27:13 -0700 | [diff] [blame] | 1155 |  | 
| Ed Tanous | 07d467b | 2021-02-23 14:48:37 -0800 | [diff] [blame] | 1156 | for (const auto& busPath : busPaths) | 
| Nikhil Potade | d8884f1 | 2019-03-27 13:27:13 -0700 | [diff] [blame] | 1157 | { | 
|  | 1158 | i2cBuses.emplace_back(busPath.second); | 
|  | 1159 | } | 
| James Feist | 4131aea | 2018-03-09 09:47:30 -0800 | [diff] [blame] | 1160 |  | 
| James Feist | 9813279 | 2019-07-09 13:29:09 -0700 | [diff] [blame] | 1161 | busmap.clear(); | 
| James Feist | 8a98392 | 2019-10-24 17:11:56 -0700 | [diff] [blame] | 1162 | for (auto& [pair, interface] : foundDevices) | 
|  | 1163 | { | 
|  | 1164 | objServer.remove_interface(interface); | 
|  | 1165 | } | 
|  | 1166 | foundDevices.clear(); | 
|  | 1167 |  | 
| Kumar Thangavel | 1e8e71f | 2021-12-01 19:39:11 +0530 | [diff] [blame] | 1168 | auto scan = std::make_shared<FindDevicesWithCallback>( | 
| Kumar Thangavel | 7f43ea8 | 2021-12-07 17:20:16 +0530 | [diff] [blame] | 1169 | i2cBuses, busmap, powerIsOn, objServer, [&]() { | 
| Patrick Williams | b707743 | 2024-08-16 15:22:21 -0400 | [diff] [blame] | 1170 | for (auto& busIface : dbusInterfaceMap) | 
| James Feist | 6ebf9de | 2018-05-15 15:01:17 -0700 | [diff] [blame] | 1171 | { | 
| Patrick Williams | b707743 | 2024-08-16 15:22:21 -0400 | [diff] [blame] | 1172 | objServer.remove_interface(busIface.second); | 
| James Feist | 6ebf9de | 2018-05-15 15:01:17 -0700 | [diff] [blame] | 1173 | } | 
| Patrick Williams | b707743 | 2024-08-16 15:22:21 -0400 | [diff] [blame] | 1174 |  | 
|  | 1175 | dbusInterfaceMap.clear(); | 
|  | 1176 | unknownBusObjectCount = 0; | 
|  | 1177 |  | 
|  | 1178 | // todo, get this from a more sensable place | 
|  | 1179 | std::vector<uint8_t> baseboardFRU; | 
|  | 1180 | if (readBaseboardFRU(baseboardFRU)) | 
|  | 1181 | { | 
|  | 1182 | // If no device on i2c bus 0, the insertion will happen. | 
|  | 1183 | auto bus0 = | 
|  | 1184 | busmap.try_emplace(0, std::make_shared<DeviceMap>()); | 
|  | 1185 | bus0.first->second->emplace(0, baseboardFRU); | 
|  | 1186 | } | 
|  | 1187 | for (auto& devicemap : busmap) | 
|  | 1188 | { | 
|  | 1189 | for (auto& device : *devicemap.second) | 
|  | 1190 | { | 
|  | 1191 | addFruObjectToDbus(device.second, dbusInterfaceMap, | 
|  | 1192 | devicemap.first, device.first, | 
|  | 1193 | unknownBusObjectCount, powerIsOn, | 
| Sora Su | 12e2d41 | 2025-08-22 14:23:16 +0800 | [diff] [blame] | 1194 | objServer); | 
| Patrick Williams | b707743 | 2024-08-16 15:22:21 -0400 | [diff] [blame] | 1195 | } | 
|  | 1196 | } | 
|  | 1197 | }); | 
| James Feist | 6ebf9de | 2018-05-15 15:01:17 -0700 | [diff] [blame] | 1198 | scan->run(); | 
|  | 1199 | }); | 
| James Feist | 918e18c | 2018-02-13 15:51:07 -0800 | [diff] [blame] | 1200 | } | 
|  | 1201 |  | 
| Naresh Solanki | cf28896 | 2025-06-06 15:26:11 +0530 | [diff] [blame] | 1202 | bool updateFruProperty( | 
|  | 1203 | const std::string& propertyValue, uint32_t bus, uint32_t address, | 
| Ed Tanous | 07d467b | 2021-02-23 14:48:37 -0800 | [diff] [blame] | 1204 | const std::string& propertyName, | 
| Joshi-Mansi | d73b744 | 2020-03-27 19:10:21 +0530 | [diff] [blame] | 1205 | boost::container::flat_map< | 
|  | 1206 | std::pair<size_t, size_t>, | 
| Kumar Thangavel | 41a9051 | 2021-11-24 15:44:20 +0530 | [diff] [blame] | 1207 | std::shared_ptr<sdbusplus::asio::dbus_interface>>& dbusInterfaceMap, | 
| Jonathan Doman | 2418a61 | 2022-02-14 18:20:58 -0800 | [diff] [blame] | 1208 | size_t& unknownBusObjectCount, const bool& powerIsOn, | 
| Sora Su | 12e2d41 | 2025-08-22 14:23:16 +0800 | [diff] [blame] | 1209 | sdbusplus::asio::object_server& objServer) | 
| Joshi-Mansi | d73b744 | 2020-03-27 19:10:21 +0530 | [diff] [blame] | 1210 | { | 
| Naresh Solanki | cf28896 | 2025-06-06 15:26:11 +0530 | [diff] [blame] | 1211 | lg2::debug( | 
|  | 1212 | "updateFruProperty called: FieldName = {NAME}, FieldValue = {VALUE}", | 
|  | 1213 | "NAME", propertyName, "VALUE", propertyValue); | 
|  | 1214 |  | 
|  | 1215 | // Validate field length: must be 2–63 characters | 
|  | 1216 | const size_t len = propertyValue.length(); | 
| Marc Olberding | 25680e3 | 2025-10-03 12:38:10 -0700 | [diff] [blame] | 1217 | if (len == 1 || len > 63) | 
| Joshi-Mansi | d73b744 | 2020-03-27 19:10:21 +0530 | [diff] [blame] | 1218 | { | 
| Marc Olberding | 25680e3 | 2025-10-03 12:38:10 -0700 | [diff] [blame] | 1219 | lg2::error( | 
|  | 1220 | "FRU field data must be 0 or between 2 and 63 characters. Invalid Length: {LEN}", | 
| Naresh Solanki | cf28896 | 2025-06-06 15:26:11 +0530 | [diff] [blame] | 1221 | "LEN", len); | 
| Joshi-Mansi | d73b744 | 2020-03-27 19:10:21 +0530 | [diff] [blame] | 1222 | return false; | 
|  | 1223 | } | 
|  | 1224 |  | 
|  | 1225 | std::vector<uint8_t> fruData; | 
| Kumar Thangavel | 9d6f590 | 2022-08-26 16:52:14 +0530 | [diff] [blame] | 1226 | if (!getFruData(fruData, bus, address)) | 
| Joshi-Mansi | d73b744 | 2020-03-27 19:10:21 +0530 | [diff] [blame] | 1227 | { | 
| Marc Olberding | 25680e3 | 2025-10-03 12:38:10 -0700 | [diff] [blame] | 1228 | lg2::error("Failure getting FRU Data from bus {BUS}, address {ADDRESS}", | 
|  | 1229 | "BUS", bus, "ADDRESS", address); | 
| Joshi-Mansi | d73b744 | 2020-03-27 19:10:21 +0530 | [diff] [blame] | 1230 | return false; | 
|  | 1231 | } | 
|  | 1232 |  | 
| Joshi-Mansi | d73b744 | 2020-03-27 19:10:21 +0530 | [diff] [blame] | 1233 | if (fruData.empty()) | 
|  | 1234 | { | 
| Marc Olberding | 25680e3 | 2025-10-03 12:38:10 -0700 | [diff] [blame] | 1235 | lg2::error("Empty FRU data\n"); | 
| Naresh Solanki | cf28896 | 2025-06-06 15:26:11 +0530 | [diff] [blame] | 1236 | return false; | 
|  | 1237 | } | 
|  | 1238 |  | 
|  | 1239 | // Extract area name (prefix before underscore) | 
| Naresh Solanki | cf28896 | 2025-06-06 15:26:11 +0530 | [diff] [blame] | 1240 | std::string areaName = propertyName.substr(0, propertyName.find('_')); | 
| Marc Olberding | 25680e3 | 2025-10-03 12:38:10 -0700 | [diff] [blame] | 1241 | auto areaIterator = | 
|  | 1242 | std::find(fruAreaNames.begin(), fruAreaNames.end(), areaName); | 
|  | 1243 | if (areaIterator == fruAreaNames.end()) | 
| Naresh Solanki | cf28896 | 2025-06-06 15:26:11 +0530 | [diff] [blame] | 1244 | { | 
| Marc Olberding | 25680e3 | 2025-10-03 12:38:10 -0700 | [diff] [blame] | 1245 | lg2::error("Failed to get FRU area for property: {AREA}", "AREA", | 
| Naresh Solanki | cf28896 | 2025-06-06 15:26:11 +0530 | [diff] [blame] | 1246 | areaName); | 
|  | 1247 | return false; | 
|  | 1248 | } | 
|  | 1249 |  | 
| Marc Olberding | 25680e3 | 2025-10-03 12:38:10 -0700 | [diff] [blame] | 1250 | fruAreas fruAreaToUpdate = static_cast<fruAreas>( | 
|  | 1251 | std::distance(fruAreaNames.begin(), areaIterator)); | 
|  | 1252 |  | 
| Naresh Solanki | cf28896 | 2025-06-06 15:26:11 +0530 | [diff] [blame] | 1253 | std::vector<std::vector<uint8_t>> areasData; | 
| Marc Olberding | 25680e3 | 2025-10-03 12:38:10 -0700 | [diff] [blame] | 1254 | if (!disassembleFruData(fruData, areasData)) | 
|  | 1255 | { | 
|  | 1256 | lg2::error("Failed to disassemble Fru Data"); | 
|  | 1257 | return false; | 
|  | 1258 | } | 
| Naresh Solanki | cf28896 | 2025-06-06 15:26:11 +0530 | [diff] [blame] | 1259 |  | 
|  | 1260 | std::vector<uint8_t>& areaData = | 
|  | 1261 | areasData[static_cast<size_t>(fruAreaToUpdate)]; | 
|  | 1262 | if (areaData.empty()) | 
|  | 1263 | { | 
|  | 1264 | // If ENABLE_FRU_AREA_RESIZE is not defined then return with failure | 
|  | 1265 | #ifndef ENABLE_FRU_AREA_RESIZE | 
| Marc Olberding | 25680e3 | 2025-10-03 12:38:10 -0700 | [diff] [blame] | 1266 | lg2::error( | 
| Naresh Solanki | cf28896 | 2025-06-06 15:26:11 +0530 | [diff] [blame] | 1267 | "FRU area {AREA} not present and ENABLE_FRU_AREA_RESIZE is not set. " | 
|  | 1268 | "Returning failure.", | 
|  | 1269 | "AREA", areaName); | 
|  | 1270 | return false; | 
|  | 1271 | #endif | 
|  | 1272 | if (!createDummyArea(fruAreaToUpdate, areaData)) | 
|  | 1273 | { | 
| Marc Olberding | 25680e3 | 2025-10-03 12:38:10 -0700 | [diff] [blame] | 1274 | lg2::error("Failed to create dummy area for {AREA}", "AREA", | 
| Naresh Solanki | cf28896 | 2025-06-06 15:26:11 +0530 | [diff] [blame] | 1275 | areaName); | 
|  | 1276 | return false; | 
|  | 1277 | } | 
|  | 1278 | } | 
|  | 1279 |  | 
|  | 1280 | if (!setField(fruAreaToUpdate, areaData, propertyName, propertyValue)) | 
|  | 1281 | { | 
| Marc Olberding | 25680e3 | 2025-10-03 12:38:10 -0700 | [diff] [blame] | 1282 | lg2::error("Failed to set field value for property: {PROPERTY}", | 
| Naresh Solanki | cf28896 | 2025-06-06 15:26:11 +0530 | [diff] [blame] | 1283 | "PROPERTY", propertyName); | 
|  | 1284 | return false; | 
|  | 1285 | } | 
|  | 1286 |  | 
| Marc Olberding | 25680e3 | 2025-10-03 12:38:10 -0700 | [diff] [blame] | 1287 | if (!assembleFruData(fruData, areasData)) | 
|  | 1288 | { | 
|  | 1289 | lg2::error("Failed to reassemble FRU data"); | 
|  | 1290 | return false; | 
|  | 1291 | } | 
| Naresh Solanki | cf28896 | 2025-06-06 15:26:11 +0530 | [diff] [blame] | 1292 |  | 
|  | 1293 | if (fruData.empty()) | 
|  | 1294 | { | 
| Marc Olberding | 25680e3 | 2025-10-03 12:38:10 -0700 | [diff] [blame] | 1295 | lg2::error("FRU data is empty after assembly"); | 
| Joshi-Mansi | d73b744 | 2020-03-27 19:10:21 +0530 | [diff] [blame] | 1296 | return false; | 
|  | 1297 | } | 
|  | 1298 |  | 
| Andrei Kartashev | 2f0de17 | 2020-08-13 14:29:40 +0300 | [diff] [blame] | 1299 | if (!writeFRU(static_cast<uint8_t>(bus), static_cast<uint8_t>(address), | 
| Joshi-Mansi | d73b744 | 2020-03-27 19:10:21 +0530 | [diff] [blame] | 1300 | fruData)) | 
|  | 1301 | { | 
| Marc Olberding | 25680e3 | 2025-10-03 12:38:10 -0700 | [diff] [blame] | 1302 | lg2::error("Failed to write the FRU"); | 
| Joshi-Mansi | d73b744 | 2020-03-27 19:10:21 +0530 | [diff] [blame] | 1303 | return false; | 
|  | 1304 | } | 
|  | 1305 |  | 
| Kumar Thangavel | 7f43ea8 | 2021-12-07 17:20:16 +0530 | [diff] [blame] | 1306 | rescanBusses(busMap, dbusInterfaceMap, unknownBusObjectCount, powerIsOn, | 
| Sora Su | 12e2d41 | 2025-08-22 14:23:16 +0800 | [diff] [blame] | 1307 | objServer); | 
| Joshi-Mansi | d73b744 | 2020-03-27 19:10:21 +0530 | [diff] [blame] | 1308 | return true; | 
|  | 1309 | } | 
|  | 1310 |  | 
| James Feist | 9813279 | 2019-07-09 13:29:09 -0700 | [diff] [blame] | 1311 | int main() | 
| James Feist | 3cb5fec | 2018-01-23 14:41:51 -0800 | [diff] [blame] | 1312 | { | 
| Kumar Thangavel | 7f43ea8 | 2021-12-07 17:20:16 +0530 | [diff] [blame] | 1313 | auto systemBus = std::make_shared<sdbusplus::asio::connection>(io); | 
|  | 1314 | sdbusplus::asio::object_server objServer(systemBus); | 
|  | 1315 |  | 
| Kumar Thangavel | 41a9051 | 2021-11-24 15:44:20 +0530 | [diff] [blame] | 1316 | static size_t unknownBusObjectCount = 0; | 
| Kumar Thangavel | 1e8e71f | 2021-12-01 19:39:11 +0530 | [diff] [blame] | 1317 | static bool powerIsOn = false; | 
| James Feist | 3cb5fec | 2018-01-23 14:41:51 -0800 | [diff] [blame] | 1318 | auto devDir = fs::path("/dev/"); | 
| James Feist | c9dff1b | 2019-02-13 13:33:13 -0800 | [diff] [blame] | 1319 | auto matchString = std::string(R"(i2c-\d+$)"); | 
| James Feist | 3cb5fec | 2018-01-23 14:41:51 -0800 | [diff] [blame] | 1320 | std::vector<fs::path> i2cBuses; | 
|  | 1321 |  | 
| James Feist | a3c180a | 2018-08-09 16:06:04 -0700 | [diff] [blame] | 1322 | if (!findFiles(devDir, matchString, i2cBuses)) | 
| James Feist | 3cb5fec | 2018-01-23 14:41:51 -0800 | [diff] [blame] | 1323 | { | 
|  | 1324 | std::cerr << "unable to find i2c devices\n"; | 
|  | 1325 | return 1; | 
|  | 1326 | } | 
| James Feist | 3cb5fec | 2018-01-23 14:41:51 -0800 | [diff] [blame] | 1327 |  | 
| Matt Simmering | 2447c24 | 2023-11-09 14:18:39 -0800 | [diff] [blame] | 1328 | // check for and load blocklist with initial buses. | 
|  | 1329 | loadBlocklist(blocklistPath); | 
| Patrick Venture | 11f1ff4 | 2019-08-01 10:42:12 -0700 | [diff] [blame] | 1330 |  | 
| Vijay Khemka | 065f6d9 | 2018-12-18 10:37:47 -0800 | [diff] [blame] | 1331 | systemBus->request_name("xyz.openbmc_project.FruDevice"); | 
| James Feist | 3cb5fec | 2018-01-23 14:41:51 -0800 | [diff] [blame] | 1332 |  | 
| James Feist | 6ebf9de | 2018-05-15 15:01:17 -0700 | [diff] [blame] | 1333 | // this is a map with keys of pair(bus number, address) and values of | 
|  | 1334 | // the object on dbus | 
| James Feist | 3cb5fec | 2018-01-23 14:41:51 -0800 | [diff] [blame] | 1335 | boost::container::flat_map<std::pair<size_t, size_t>, | 
| James Feist | 9eb0b58 | 2018-04-27 12:15:46 -0700 | [diff] [blame] | 1336 | std::shared_ptr<sdbusplus::asio::dbus_interface>> | 
|  | 1337 | dbusInterfaceMap; | 
| James Feist | 3cb5fec | 2018-01-23 14:41:51 -0800 | [diff] [blame] | 1338 |  | 
| James Feist | 9eb0b58 | 2018-04-27 12:15:46 -0700 | [diff] [blame] | 1339 | std::shared_ptr<sdbusplus::asio::dbus_interface> iface = | 
|  | 1340 | objServer.add_interface("/xyz/openbmc_project/FruDevice", | 
|  | 1341 | "xyz.openbmc_project.FruDeviceManager"); | 
| James Feist | 3cb5fec | 2018-01-23 14:41:51 -0800 | [diff] [blame] | 1342 |  | 
| Kumar Thangavel | 41a9051 | 2021-11-24 15:44:20 +0530 | [diff] [blame] | 1343 | iface->register_method("ReScan", [&]() { | 
| Kumar Thangavel | 7f43ea8 | 2021-12-07 17:20:16 +0530 | [diff] [blame] | 1344 | rescanBusses(busMap, dbusInterfaceMap, unknownBusObjectCount, powerIsOn, | 
| Sora Su | 12e2d41 | 2025-08-22 14:23:16 +0800 | [diff] [blame] | 1345 | objServer); | 
| Kumar Thangavel | 41a9051 | 2021-11-24 15:44:20 +0530 | [diff] [blame] | 1346 | }); | 
| James Feist | 2a9d6db | 2018-04-27 15:48:28 -0700 | [diff] [blame] | 1347 |  | 
| krishnar4 | 213ee21 | 2022-11-11 15:39:30 +0530 | [diff] [blame] | 1348 | iface->register_method("ReScanBus", [&](uint16_t bus) { | 
| Kumar Thangavel | 1e8e71f | 2021-12-01 19:39:11 +0530 | [diff] [blame] | 1349 | rescanOneBus(busMap, bus, dbusInterfaceMap, true, unknownBusObjectCount, | 
| Sora Su | 12e2d41 | 2025-08-22 14:23:16 +0800 | [diff] [blame] | 1350 | powerIsOn, objServer); | 
| Cheng C Yang | d5b87fb | 2020-01-23 10:10:45 +0800 | [diff] [blame] | 1351 | }); | 
|  | 1352 |  | 
| Andrei Kartashev | 2f0de17 | 2020-08-13 14:29:40 +0300 | [diff] [blame] | 1353 | iface->register_method("GetRawFru", getFRUInfo); | 
| James Feist | b49ffc3 | 2018-05-02 11:10:43 -0700 | [diff] [blame] | 1354 |  | 
| Patrick Williams | b707743 | 2024-08-16 15:22:21 -0400 | [diff] [blame] | 1355 | iface->register_method( | 
|  | 1356 | "WriteFru", [&](const uint16_t bus, const uint8_t address, | 
|  | 1357 | const std::vector<uint8_t>& data) { | 
|  | 1358 | if (!writeFRU(bus, address, data)) | 
|  | 1359 | { | 
|  | 1360 | throw std::invalid_argument("Invalid Arguments."); | 
|  | 1361 | return; | 
|  | 1362 | } | 
|  | 1363 | // schedule rescan on success | 
|  | 1364 | rescanBusses(busMap, dbusInterfaceMap, unknownBusObjectCount, | 
| Sora Su | 12e2d41 | 2025-08-22 14:23:16 +0800 | [diff] [blame] | 1365 | powerIsOn, objServer); | 
| Patrick Williams | b707743 | 2024-08-16 15:22:21 -0400 | [diff] [blame] | 1366 | }); | 
| James Feist | 9eb0b58 | 2018-04-27 12:15:46 -0700 | [diff] [blame] | 1367 | iface->initialize(); | 
| James Feist | 3cb5fec | 2018-01-23 14:41:51 -0800 | [diff] [blame] | 1368 |  | 
| Patrick Williams | 2af3922 | 2022-07-22 19:26:56 -0500 | [diff] [blame] | 1369 | std::function<void(sdbusplus::message_t & message)> eventHandler = | 
|  | 1370 | [&](sdbusplus::message_t& message) { | 
| Patrick Williams | b707743 | 2024-08-16 15:22:21 -0400 | [diff] [blame] | 1371 | std::string objectName; | 
|  | 1372 | boost::container::flat_map< | 
|  | 1373 | std::string, | 
|  | 1374 | std::variant<std::string, bool, int64_t, uint64_t, double>> | 
|  | 1375 | values; | 
|  | 1376 | message.read(objectName, values); | 
|  | 1377 | auto findState = values.find("CurrentHostState"); | 
|  | 1378 | if (findState != values.end()) | 
| James Feist | 918e18c | 2018-02-13 15:51:07 -0800 | [diff] [blame] | 1379 | { | 
| Patrick Williams | b707743 | 2024-08-16 15:22:21 -0400 | [diff] [blame] | 1380 | if (std::get<std::string>(findState->second) == | 
|  | 1381 | "xyz.openbmc_project.State.Host.HostState.Running") | 
|  | 1382 | { | 
|  | 1383 | powerIsOn = true; | 
|  | 1384 | } | 
| James Feist | 0eeb79c | 2019-10-09 13:35:29 -0700 | [diff] [blame] | 1385 | } | 
| James Feist | 6ebf9de | 2018-05-15 15:01:17 -0700 | [diff] [blame] | 1386 |  | 
| Patrick Williams | b707743 | 2024-08-16 15:22:21 -0400 | [diff] [blame] | 1387 | if (powerIsOn) | 
|  | 1388 | { | 
|  | 1389 | rescanBusses(busMap, dbusInterfaceMap, unknownBusObjectCount, | 
| Sora Su | 12e2d41 | 2025-08-22 14:23:16 +0800 | [diff] [blame] | 1390 | powerIsOn, objServer); | 
| Patrick Williams | b707743 | 2024-08-16 15:22:21 -0400 | [diff] [blame] | 1391 | } | 
|  | 1392 | }; | 
| James Feist | 9eb0b58 | 2018-04-27 12:15:46 -0700 | [diff] [blame] | 1393 |  | 
| Patrick Williams | 2af3922 | 2022-07-22 19:26:56 -0500 | [diff] [blame] | 1394 | sdbusplus::bus::match_t powerMatch = sdbusplus::bus::match_t( | 
|  | 1395 | static_cast<sdbusplus::bus_t&>(*systemBus), | 
| James Feist | 7bcd3f2 | 2019-03-18 16:04:04 -0700 | [diff] [blame] | 1396 | "type='signal',interface='org.freedesktop.DBus.Properties',path='/xyz/" | 
| James Feist | 0eeb79c | 2019-10-09 13:35:29 -0700 | [diff] [blame] | 1397 | "openbmc_project/state/" | 
|  | 1398 | "host0',arg0='xyz.openbmc_project.State.Host'", | 
| James Feist | 9eb0b58 | 2018-04-27 12:15:46 -0700 | [diff] [blame] | 1399 | eventHandler); | 
|  | 1400 |  | 
| James Feist | 4131aea | 2018-03-09 09:47:30 -0800 | [diff] [blame] | 1401 | int fd = inotify_init(); | 
| Ed Tanous | 07d467b | 2021-02-23 14:48:37 -0800 | [diff] [blame] | 1402 | inotify_add_watch(fd, i2CDevLocation, IN_CREATE | IN_MOVED_TO | IN_DELETE); | 
| Ed Tanous | 3013fb4 | 2022-07-09 08:27:06 -0700 | [diff] [blame] | 1403 | std::array<char, 4096> readBuffer{}; | 
| James Feist | 4131aea | 2018-03-09 09:47:30 -0800 | [diff] [blame] | 1404 | // monitor for new i2c devices | 
|  | 1405 | boost::asio::posix::stream_descriptor dirWatch(io, fd); | 
|  | 1406 | std::function<void(const boost::system::error_code, std::size_t)> | 
| Patrick Williams | b9dd7f8 | 2023-10-20 11:20:11 -0500 | [diff] [blame] | 1407 | watchI2cBusses = [&](const boost::system::error_code& ec, | 
|  | 1408 | std::size_t bytesTransferred) { | 
| Patrick Williams | b707743 | 2024-08-16 15:22:21 -0400 | [diff] [blame] | 1409 | if (ec) | 
| James Feist | 4131aea | 2018-03-09 09:47:30 -0800 | [diff] [blame] | 1410 | { | 
| Patrick Williams | b707743 | 2024-08-16 15:22:21 -0400 | [diff] [blame] | 1411 | std::cout << "Callback Error " << ec << "\n"; | 
|  | 1412 | return; | 
|  | 1413 | } | 
|  | 1414 | size_t index = 0; | 
|  | 1415 | while ((index + sizeof(inotify_event)) <= bytesTransferred) | 
|  | 1416 | { | 
|  | 1417 | const char* p = &readBuffer[index]; | 
|  | 1418 | // NOLINTNEXTLINE(cppcoreguidelines-pro-type-reinterpret-cast) | 
|  | 1419 | const auto* iEvent = reinterpret_cast<const inotify_event*>(p); | 
|  | 1420 | switch (iEvent->mask) | 
| Ed Tanous | fc17142 | 2024-04-04 17:18:16 -0700 | [diff] [blame] | 1421 | { | 
| Patrick Williams | b707743 | 2024-08-16 15:22:21 -0400 | [diff] [blame] | 1422 | case IN_CREATE: | 
|  | 1423 | case IN_MOVED_TO: | 
|  | 1424 | case IN_DELETE: | 
| Patrick Williams | df19061 | 2023-05-10 07:51:34 -0500 | [diff] [blame] | 1425 | { | 
| Patrick Williams | b707743 | 2024-08-16 15:22:21 -0400 | [diff] [blame] | 1426 | std::string_view name(&iEvent->name[0], iEvent->len); | 
| George Liu | 164af2f | 2025-08-21 17:16:31 +0800 | [diff] [blame] | 1427 | if (name.starts_with("i2c")) | 
| James Feist | 9eb0b58 | 2018-04-27 12:15:46 -0700 | [diff] [blame] | 1428 | { | 
| Patrick Williams | b707743 | 2024-08-16 15:22:21 -0400 | [diff] [blame] | 1429 | int bus = busStrToInt(name); | 
|  | 1430 | if (bus < 0) | 
|  | 1431 | { | 
|  | 1432 | std::cerr | 
|  | 1433 | << "Could not parse bus " << name << "\n"; | 
|  | 1434 | continue; | 
|  | 1435 | } | 
|  | 1436 | int rootBus = getRootBus(bus); | 
|  | 1437 | if (rootBus >= 0) | 
|  | 1438 | { | 
|  | 1439 | rescanOneBus(busMap, | 
|  | 1440 | static_cast<uint16_t>(rootBus), | 
|  | 1441 | dbusInterfaceMap, false, | 
|  | 1442 | unknownBusObjectCount, powerIsOn, | 
| Sora Su | 12e2d41 | 2025-08-22 14:23:16 +0800 | [diff] [blame] | 1443 | objServer); | 
| Patrick Williams | b707743 | 2024-08-16 15:22:21 -0400 | [diff] [blame] | 1444 | } | 
|  | 1445 | rescanOneBus(busMap, static_cast<uint16_t>(bus), | 
| Kumar Thangavel | 41a9051 | 2021-11-24 15:44:20 +0530 | [diff] [blame] | 1446 | dbusInterfaceMap, false, | 
| Kumar Thangavel | 7f43ea8 | 2021-12-07 17:20:16 +0530 | [diff] [blame] | 1447 | unknownBusObjectCount, powerIsOn, | 
| Sora Su | 12e2d41 | 2025-08-22 14:23:16 +0800 | [diff] [blame] | 1448 | objServer); | 
| James Feist | 9eb0b58 | 2018-04-27 12:15:46 -0700 | [diff] [blame] | 1449 | } | 
| Patrick Williams | df19061 | 2023-05-10 07:51:34 -0500 | [diff] [blame] | 1450 | } | 
| Ed Tanous | fc17142 | 2024-04-04 17:18:16 -0700 | [diff] [blame] | 1451 | break; | 
| Patrick Williams | b707743 | 2024-08-16 15:22:21 -0400 | [diff] [blame] | 1452 | default: | 
|  | 1453 | break; | 
|  | 1454 | } | 
|  | 1455 | index += sizeof(inotify_event) + iEvent->len; | 
| James Feist | 4131aea | 2018-03-09 09:47:30 -0800 | [diff] [blame] | 1456 | } | 
| James Feist | 6ebf9de | 2018-05-15 15:01:17 -0700 | [diff] [blame] | 1457 |  | 
| Patrick Williams | b707743 | 2024-08-16 15:22:21 -0400 | [diff] [blame] | 1458 | dirWatch.async_read_some(boost::asio::buffer(readBuffer), | 
|  | 1459 | watchI2cBusses); | 
|  | 1460 | }; | 
| James Feist | 4131aea | 2018-03-09 09:47:30 -0800 | [diff] [blame] | 1461 |  | 
|  | 1462 | dirWatch.async_read_some(boost::asio::buffer(readBuffer), watchI2cBusses); | 
| Gunnar Mills | b3e42fe | 2018-06-13 15:48:27 -0500 | [diff] [blame] | 1463 | // run the initial scan | 
| Kumar Thangavel | 7f43ea8 | 2021-12-07 17:20:16 +0530 | [diff] [blame] | 1464 | rescanBusses(busMap, dbusInterfaceMap, unknownBusObjectCount, powerIsOn, | 
| Sora Su | 12e2d41 | 2025-08-22 14:23:16 +0800 | [diff] [blame] | 1465 | objServer); | 
| James Feist | 918e18c | 2018-02-13 15:51:07 -0800 | [diff] [blame] | 1466 |  | 
| James Feist | 3cb5fec | 2018-01-23 14:41:51 -0800 | [diff] [blame] | 1467 | io.run(); | 
|  | 1468 | return 0; | 
|  | 1469 | } |