blob: f6d24769205850bbd56f50210a744ab425cadf9f [file] [log] [blame]
James Feistc95cb142018-02-26 10:41:42 -08001/*
2// Copyright (c) 2018 Intel Corporation
3//
4// Licensed under the Apache License, Version 2.0 (the "License");
5// you may not use this file except in compliance with the License.
6// You may obtain a copy of the License at
7//
8// http://www.apache.org/licenses/LICENSE-2.0
9//
10// Unless required by applicable law or agreed to in writing, software
11// distributed under the License is distributed on an "AS IS" BASIS,
12// WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
13// See the License for the specific language governing permissions and
14// limitations under the License.
15*/
Brad Bishope45d8c72022-05-25 15:12:53 -040016/// \file overlay.cpp
James Feistc95cb142018-02-26 10:41:42 -080017
Brad Bishope45d8c72022-05-25 15:12:53 -040018#include "overlay.hpp"
Patrick Venturea49dc332019-10-26 08:32:02 -070019
Patrick Venturea49dc332019-10-26 08:32:02 -070020#include "devices.hpp"
Ed Tanous3013fb42022-07-09 08:27:06 -070021#include "utils.hpp"
Patrick Venturea49dc332019-10-26 08:32:02 -070022
James Feista465ccc2019-02-08 12:51:01 -080023#include <boost/algorithm/string/predicate.hpp>
Johnathan Mantey9b867872020-10-13 15:00:51 -070024#include <boost/asio/io_context.hpp>
25#include <boost/asio/steady_timer.hpp>
James Feista465ccc2019-02-08 12:51:01 -080026#include <boost/container/flat_map.hpp>
27#include <boost/container/flat_set.hpp>
28#include <boost/process/child.hpp>
James Feist8c505da2020-05-28 10:06:33 -070029#include <nlohmann/json.hpp>
30
James Feist637b3ef2019-04-15 16:35:30 -070031#include <filesystem>
James Feista465ccc2019-02-08 12:51:01 -080032#include <iomanip>
33#include <iostream>
James Feista465ccc2019-02-08 12:51:01 -080034#include <regex>
35#include <string>
James Feistc95cb142018-02-26 10:41:42 -080036
Ed Tanous07d467b2021-02-23 14:48:37 -080037constexpr const char* outputDir = "/tmp/overlays";
38constexpr const char* templateChar = "$";
39constexpr const char* i2CDevsDir = "/sys/bus/i2c/devices";
40constexpr const char* muxSymlinkDir = "/dev/i2c-mux";
James Feistc95cb142018-02-26 10:41:42 -080041
Ed Tanous07d467b2021-02-23 14:48:37 -080042constexpr const bool debug = false;
Josh Lehan96b8a6e2019-10-09 14:39:49 -070043
Ed Tanousfc171422024-04-04 17:18:16 -070044const std::regex illegalNameRegex("[^A-Za-z0-9_]");
James Feistc95cb142018-02-26 10:41:42 -080045
James Feistc95cb142018-02-26 10:41:42 -080046// helper function to make json types into string
James Feista465ccc2019-02-08 12:51:01 -080047std::string jsonToString(const nlohmann::json& in)
James Feistc95cb142018-02-26 10:41:42 -080048{
49 if (in.type() == nlohmann::json::value_t::string)
50 {
51 return in.get<std::string>();
52 }
Ed Tanous07d467b2021-02-23 14:48:37 -080053 if (in.type() == nlohmann::json::value_t::array)
James Feistc95cb142018-02-26 10:41:42 -080054 {
55 // remove brackets and comma from array
56 std::string array = in.dump();
57 array = array.substr(1, array.size() - 2);
58 boost::replace_all(array, ",", " ");
59 return array;
60 }
61 return in.dump();
62}
63
Zev Weiss9afef3a2022-07-13 16:38:23 -070064static std::string deviceDirName(uint64_t bus, uint64_t address)
65{
66 std::ostringstream name;
Johnathan Mantey7b21ef22022-08-08 12:57:55 -070067 name << bus << "-" << std::hex << std::setw(4) << std::setfill('0')
68 << address;
Zev Weiss9afef3a2022-07-13 16:38:23 -070069 return name.str();
70}
71
Jonathan Domand0eb1292023-04-19 11:21:56 -070072void linkMux(const std::string& muxName, uint64_t busIndex, uint64_t address,
Jonathan Doman6af72c92023-04-19 11:55:39 -070073 const std::vector<std::string>& channelNames)
James Feistc95cb142018-02-26 10:41:42 -080074{
James Feist286babc2019-02-07 16:48:28 -080075 std::error_code ec;
Ed Tanous07d467b2021-02-23 14:48:37 -080076 std::filesystem::path muxSymlinkDirPath(muxSymlinkDir);
77 std::filesystem::create_directory(muxSymlinkDirPath, ec);
Ed Tanousee3357a2019-02-26 12:44:14 -080078 // ignore error codes here if the directory already exists
79 ec.clear();
Ed Tanous07d467b2021-02-23 14:48:37 -080080 std::filesystem::path linkDir = muxSymlinkDirPath / muxName;
Ed Tanousee3357a2019-02-26 12:44:14 -080081 std::filesystem::create_directory(linkDir, ec);
82
Ed Tanous07d467b2021-02-23 14:48:37 -080083 std::filesystem::path devDir(i2CDevsDir);
Zev Weiss9afef3a2022-07-13 16:38:23 -070084 devDir /= deviceDirName(busIndex, address);
James Feist286babc2019-02-07 16:48:28 -080085
Ed Tanousee3357a2019-02-26 12:44:14 -080086 for (std::size_t channelIndex = 0; channelIndex < channelNames.size();
87 channelIndex++)
James Feist286babc2019-02-07 16:48:28 -080088 {
Jonathan Doman6af72c92023-04-19 11:55:39 -070089 const std::string& channelName = channelNames[channelIndex];
90 if (channelName.empty())
Ed Tanousee3357a2019-02-26 12:44:14 -080091 {
92 continue;
93 }
94
95 std::filesystem::path channelPath =
96 devDir / ("channel-" + std::to_string(channelIndex));
97 if (!is_symlink(channelPath))
98 {
Jonathan Doman6af72c92023-04-19 11:55:39 -070099 std::cerr << channelPath << " for mux channel " << channelName
Ed Tanousee3357a2019-02-26 12:44:14 -0800100 << " doesn't exist!\n";
101 continue;
102 }
103 std::filesystem::path bus = std::filesystem::read_symlink(channelPath);
104
105 std::filesystem::path fp("/dev" / bus.filename());
Jonathan Doman6af72c92023-04-19 11:55:39 -0700106 std::filesystem::path link(linkDir / channelName);
Ed Tanousee3357a2019-02-26 12:44:14 -0800107
108 std::filesystem::create_symlink(fp, link, ec);
109 if (ec)
110 {
111 std::cerr << "Failure creating symlink for " << fp << " to " << link
112 << "\n";
113 }
James Feistc95cb142018-02-26 10:41:42 -0800114 }
115}
116
Jonathan Domand0eb1292023-04-19 11:21:56 -0700117static int deleteDevice(const std::string& busPath, uint64_t address,
Johnathan Mantey9b867872020-10-13 15:00:51 -0700118 const std::string& destructor)
119{
Zev Weissc11b5da2022-07-12 16:31:37 -0700120 std::filesystem::path deviceDestructor(busPath);
Johnathan Mantey9b867872020-10-13 15:00:51 -0700121 deviceDestructor /= destructor;
122 std::ofstream deviceFile(deviceDestructor);
123 if (!deviceFile.good())
124 {
125 std::cerr << "Error writing " << deviceDestructor << "\n";
126 return -1;
127 }
Jonathan Domand0eb1292023-04-19 11:21:56 -0700128 deviceFile << std::to_string(address);
Johnathan Mantey9b867872020-10-13 15:00:51 -0700129 deviceFile.close();
130 return 0;
131}
132
Zev Weissc11b5da2022-07-12 16:31:37 -0700133static int createDevice(const std::string& busPath,
Johnathan Mantey9b867872020-10-13 15:00:51 -0700134 const std::string& parameters,
135 const std::string& constructor)
136{
Zev Weissc11b5da2022-07-12 16:31:37 -0700137 std::filesystem::path deviceConstructor(busPath);
Johnathan Mantey9b867872020-10-13 15:00:51 -0700138 deviceConstructor /= constructor;
139 std::ofstream deviceFile(deviceConstructor);
140 if (!deviceFile.good())
141 {
142 std::cerr << "Error writing " << deviceConstructor << "\n";
143 return -1;
144 }
145 deviceFile << parameters;
146 deviceFile.close();
147
148 return 0;
149}
150
Jonathan Domand0eb1292023-04-19 11:21:56 -0700151static bool deviceIsCreated(const std::string& busPath, uint64_t bus,
152 uint64_t address,
Johnathan Mantey7b21ef22022-08-08 12:57:55 -0700153 const devices::createsHWMon hasHWMonDir)
Johnathan Mantey9b867872020-10-13 15:00:51 -0700154{
Zev Weiss67003d62022-07-15 16:38:19 -0700155 std::filesystem::path dirPath = busPath;
Jonathan Domand0eb1292023-04-19 11:21:56 -0700156 dirPath /= deviceDirName(bus, address);
Johnathan Mantey7b21ef22022-08-08 12:57:55 -0700157 if (hasHWMonDir == devices::createsHWMon::hasHWMonDir)
Zev Weiss67003d62022-07-15 16:38:19 -0700158 {
159 dirPath /= "hwmon";
160 }
Johnathan Mantey9b867872020-10-13 15:00:51 -0700161
Ed Tanous37e142b2021-04-30 12:19:26 -0700162 std::error_code ec;
Zev Weiss67003d62022-07-15 16:38:19 -0700163 // Ignore errors; anything but a clean 'true' is just fine as 'false'
164 return std::filesystem::exists(dirPath, ec);
Johnathan Mantey9b867872020-10-13 15:00:51 -0700165}
166
Patrick Williamsb7077432024-08-16 15:22:21 -0400167static int
168 buildDevice(const std::string& name, const std::string& busPath,
169 const std::string& parameters, uint64_t bus, uint64_t address,
170 const std::string& constructor, const std::string& destructor,
171 const devices::createsHWMon hasHWMonDir,
172 std::vector<std::string> channelNames, const size_t retries = 5)
Johnathan Mantey9b867872020-10-13 15:00:51 -0700173{
Ed Tanous3013fb42022-07-09 08:27:06 -0700174 if (retries == 0U)
Johnathan Mantey9b867872020-10-13 15:00:51 -0700175 {
176 return -1;
177 }
178
Jonathan Doman6af72c92023-04-19 11:55:39 -0700179 // If it's already instantiated, we don't need to create it again.
Johnathan Mantey7b21ef22022-08-08 12:57:55 -0700180 if (!deviceIsCreated(busPath, bus, address, hasHWMonDir))
Johnathan Mantey9b867872020-10-13 15:00:51 -0700181 {
Jonathan Doman6af72c92023-04-19 11:55:39 -0700182 // Try to create the device
183 createDevice(busPath, parameters, constructor);
Zev Weisscbcd17f2022-07-15 15:39:21 -0700184
Jonathan Doman6af72c92023-04-19 11:55:39 -0700185 // If it didn't work, delete it and try again in 500ms
186 if (!deviceIsCreated(busPath, bus, address, hasHWMonDir))
187 {
188 deleteDevice(busPath, address, destructor);
189
190 std::shared_ptr<boost::asio::steady_timer> createTimer =
191 std::make_shared<boost::asio::steady_timer>(io);
192 createTimer->expires_after(std::chrono::milliseconds(500));
193 createTimer->async_wait(
194 [createTimer, name, busPath, parameters, bus, address,
195 constructor, destructor, hasHWMonDir,
196 channelNames(std::move(channelNames)),
197 retries](const boost::system::error_code& ec) mutable {
Patrick Williamsb7077432024-08-16 15:22:21 -0400198 if (ec)
199 {
200 std::cerr << "Timer error: " << ec << "\n";
201 return -2;
202 }
203 return buildDevice(name, busPath, parameters, bus, address,
204 constructor, destructor, hasHWMonDir,
205 std::move(channelNames), retries - 1);
206 });
Jonathan Doman6af72c92023-04-19 11:55:39 -0700207 return -1;
208 }
209 }
210
211 // Link the mux channels if needed once the device is created.
212 if (!channelNames.empty())
213 {
214 linkMux(name, bus, address, channelNames);
Johnathan Mantey9b867872020-10-13 15:00:51 -0700215 }
Zev Weisscbcd17f2022-07-15 15:39:21 -0700216
Johnathan Mantey9b867872020-10-13 15:00:51 -0700217 return 0;
218}
219
James Feista465ccc2019-02-08 12:51:01 -0800220void exportDevice(const std::string& type,
221 const devices::ExportTemplate& exportTemplate,
222 const nlohmann::json& configuration)
James Feist053a6642018-10-15 13:17:09 -0700223{
James Feist053a6642018-10-15 13:17:09 -0700224 std::string parameters = exportTemplate.parameters;
Zev Weissc11b5da2022-07-12 16:31:37 -0700225 std::string busPath = exportTemplate.busPath;
Johnathan Mantey9b867872020-10-13 15:00:51 -0700226 std::string constructor = exportTemplate.add;
227 std::string destructor = exportTemplate.remove;
Johnathan Mantey7b21ef22022-08-08 12:57:55 -0700228 devices::createsHWMon hasHWMonDir = exportTemplate.hasHWMonDir;
James Feist053a6642018-10-15 13:17:09 -0700229 std::string name = "unknown";
Jonathan Domand0eb1292023-04-19 11:21:56 -0700230 std::optional<uint64_t> bus;
231 std::optional<uint64_t> address;
Jonathan Doman6af72c92023-04-19 11:55:39 -0700232 std::vector<std::string> channels;
James Feist053a6642018-10-15 13:17:09 -0700233
234 for (auto keyPair = configuration.begin(); keyPair != configuration.end();
235 keyPair++)
236 {
237 std::string subsituteString;
238
239 if (keyPair.key() == "Name" &&
240 keyPair.value().type() == nlohmann::json::value_t::string)
241 {
242 subsituteString = std::regex_replace(
Ed Tanous07d467b2021-02-23 14:48:37 -0800243 keyPair.value().get<std::string>(), illegalNameRegex, "_");
James Feist053a6642018-10-15 13:17:09 -0700244 name = subsituteString;
245 }
246 else
247 {
248 subsituteString = jsonToString(keyPair.value());
249 }
250
251 if (keyPair.key() == "Bus")
252 {
Jonathan Domand0eb1292023-04-19 11:21:56 -0700253 bus = keyPair.value().get<uint64_t>();
James Feist053a6642018-10-15 13:17:09 -0700254 }
255 else if (keyPair.key() == "Address")
256 {
Jonathan Domand0eb1292023-04-19 11:21:56 -0700257 address = keyPair.value().get<uint64_t>();
James Feist053a6642018-10-15 13:17:09 -0700258 }
Jonathan Doman6af72c92023-04-19 11:55:39 -0700259 else if (keyPair.key() == "ChannelNames" && type.ends_with("Mux"))
James Feist286babc2019-02-07 16:48:28 -0800260 {
Jonathan Doman6af72c92023-04-19 11:55:39 -0700261 channels = keyPair.value().get<std::vector<std::string>>();
James Feist286babc2019-02-07 16:48:28 -0800262 }
Ed Tanous07d467b2021-02-23 14:48:37 -0800263 boost::replace_all(parameters, templateChar + keyPair.key(),
James Feist053a6642018-10-15 13:17:09 -0700264 subsituteString);
Zev Weissc11b5da2022-07-12 16:31:37 -0700265 boost::replace_all(busPath, templateChar + keyPair.key(),
James Feist053a6642018-10-15 13:17:09 -0700266 subsituteString);
267 }
268
Jonathan Domand0eb1292023-04-19 11:21:56 -0700269 if (!bus || !address)
270 {
271 createDevice(busPath, parameters, constructor);
272 return;
273 }
274
Jonathan Doman6af72c92023-04-19 11:55:39 -0700275 buildDevice(name, busPath, parameters, *bus, *address, constructor,
276 destructor, hasHWMonDir, std::move(channels));
James Feist053a6642018-10-15 13:17:09 -0700277}
278
James Feista465ccc2019-02-08 12:51:01 -0800279bool loadOverlays(const nlohmann::json& systemConfiguration)
James Feistc95cb142018-02-26 10:41:42 -0800280{
Ed Tanous07d467b2021-02-23 14:48:37 -0800281 std::filesystem::create_directory(outputDir);
James Feistc95cb142018-02-26 10:41:42 -0800282 for (auto entity = systemConfiguration.begin();
283 entity != systemConfiguration.end(); entity++)
284 {
James Feist1e3e6982018-08-03 16:09:28 -0700285 auto findExposes = entity.value().find("Exposes");
James Feistc95cb142018-02-26 10:41:42 -0800286 if (findExposes == entity.value().end() ||
287 findExposes->type() != nlohmann::json::value_t::array)
288 {
289 continue;
290 }
291
Ed Tanous3013fb42022-07-09 08:27:06 -0700292 for (const auto& configuration : *findExposes)
James Feistc95cb142018-02-26 10:41:42 -0800293 {
James Feist1e3e6982018-08-03 16:09:28 -0700294 auto findStatus = configuration.find("Status");
James Feistc95cb142018-02-26 10:41:42 -0800295 // status missing is assumed to be 'okay'
296 if (findStatus != configuration.end() && *findStatus == "disabled")
297 {
298 continue;
299 }
James Feistd63d18a2018-07-19 15:23:45 -0700300 auto findType = configuration.find("Type");
James Feistc95cb142018-02-26 10:41:42 -0800301 if (findType == configuration.end() ||
302 findType->type() != nlohmann::json::value_t::string)
303 {
304 continue;
305 }
306 std::string type = findType.value().get<std::string>();
James Feist053a6642018-10-15 13:17:09 -0700307 auto device = devices::exportTemplates.find(type.c_str());
308 if (device != devices::exportTemplates.end())
309 {
James Feist286babc2019-02-07 16:48:28 -0800310 exportDevice(type, device->second, configuration);
Josh Lehan96b8a6e2019-10-09 14:39:49 -0700311 continue;
312 }
313
314 // Because many devices are intentionally not exportable,
315 // this error message is not printed in all situations.
316 // If wondering why your device not appearing, add your type to
317 // the exportTemplates array in the devices.hpp file.
Ed Tanous07d467b2021-02-23 14:48:37 -0800318 if constexpr (debug)
Josh Lehan96b8a6e2019-10-09 14:39:49 -0700319 {
320 std::cerr << "Device type " << type
Matt Simmering2447c242023-11-09 14:18:39 -0800321 << " not found in export map allowlist\n";
James Feist053a6642018-10-15 13:17:09 -0700322 }
James Feistc95cb142018-02-26 10:41:42 -0800323 }
324 }
325
326 return true;
Jae Hyun Yoo6d1d0142018-07-25 10:07:43 -0700327}