| George Liu | b615162 | 2020-11-23 18:16:18 +0800 | [diff] [blame] | 1 | #include "config.h" | 
|  | 2 |  | 
| Patrick Venture | 91ac8d3 | 2018-11-01 17:03:22 -0700 | [diff] [blame] | 3 | #include "manager.hpp" | 
|  | 4 |  | 
| George Liu | e9fb5c6 | 2021-07-01 14:05:32 +0800 | [diff] [blame] | 5 | #include <phosphor-logging/lg2.hpp> | 
| William A. Kennington III | 151122a | 2018-05-15 12:00:32 -0700 | [diff] [blame] | 6 | #include <sdbusplus/exception.hpp> | 
| Vishwanatha Subbanna | 4fa9248 | 2017-03-10 14:39:20 +0530 | [diff] [blame] | 7 | #include <xyz/openbmc_project/Led/Physical/server.hpp> | 
| George Liu | a6c18f8 | 2020-06-22 10:50:04 +0800 | [diff] [blame] | 8 |  | 
|  | 9 | #include <algorithm> | 
|  | 10 | #include <iostream> | 
|  | 11 | #include <string> | 
| Vishwanatha Subbanna | 4c8c72b | 2016-11-29 23:02:06 +0530 | [diff] [blame] | 12 | namespace phosphor | 
|  | 13 | { | 
|  | 14 | namespace led | 
|  | 15 | { | 
|  | 16 |  | 
|  | 17 | // Assert -or- De-assert | 
| Vishwanatha Subbanna | ed49073 | 2016-12-20 15:59:29 +0530 | [diff] [blame] | 18 | bool Manager::setGroupState(const std::string& path, bool assert, | 
| Patrick Williams | 158b2c1 | 2022-03-17 05:57:44 -0500 | [diff] [blame] | 19 | ActionSet& ledsAssert, ActionSet& ledsDeAssert) | 
| Vishwanatha Subbanna | 4c8c72b | 2016-11-29 23:02:06 +0530 | [diff] [blame] | 20 | { | 
|  | 21 | if (assert) | 
|  | 22 | { | 
|  | 23 | assertedGroups.insert(&ledMap.at(path)); | 
|  | 24 | } | 
|  | 25 | else | 
|  | 26 | { | 
| George Liu | 7f53a03 | 2021-05-04 11:18:21 +0800 | [diff] [blame] | 27 | if (assertedGroups.contains(&ledMap.at(path))) | 
| Vishwanatha Subbanna | 4c8c72b | 2016-11-29 23:02:06 +0530 | [diff] [blame] | 28 | { | 
|  | 29 | assertedGroups.erase(&ledMap.at(path)); | 
|  | 30 | } | 
|  | 31 | } | 
| Vishwanatha Subbanna | 4c8c72b | 2016-11-29 23:02:06 +0530 | [diff] [blame] | 32 |  | 
| Patrick Williams | 158b2c1 | 2022-03-17 05:57:44 -0500 | [diff] [blame] | 33 | // This will contain the union of what's already in the asserted ActionSet | 
|  | 34 | ActionSet desiredState{}; | 
| Patrick Venture | 91ac8d3 | 2018-11-01 17:03:22 -0700 | [diff] [blame] | 35 | for (const auto& grp : assertedGroups) | 
| Vishwanatha Subbanna | 4c8c72b | 2016-11-29 23:02:06 +0530 | [diff] [blame] | 36 | { | 
|  | 37 | desiredState.insert(grp->cbegin(), grp->cend()); | 
|  | 38 | } | 
|  | 39 |  | 
| Vishwanatha Subbanna | 4b000d8 | 2017-05-03 18:44:16 +0530 | [diff] [blame] | 40 | // Find difference between Combined and Desired to identify | 
|  | 41 | // which LEDs are getting altered | 
| Patrick Williams | 158b2c1 | 2022-03-17 05:57:44 -0500 | [diff] [blame] | 42 | ActionSet transient{}; | 
| Vishwanatha Subbanna | 4b000d8 | 2017-05-03 18:44:16 +0530 | [diff] [blame] | 43 | std::set_difference(combinedState.begin(), combinedState.end(), | 
| Vishwanatha Subbanna | 4c8c72b | 2016-11-29 23:02:06 +0530 | [diff] [blame] | 44 | desiredState.begin(), desiredState.end(), | 
| Patrick Venture | 91ac8d3 | 2018-11-01 17:03:22 -0700 | [diff] [blame] | 45 | std::inserter(transient, transient.begin()), ledComp); | 
|  | 46 | if (transient.size()) | 
| Vishwanatha Subbanna | 4c8c72b | 2016-11-29 23:02:06 +0530 | [diff] [blame] | 47 | { | 
| Vishwanatha Subbanna | 4b000d8 | 2017-05-03 18:44:16 +0530 | [diff] [blame] | 48 | // Find common LEDs between transient and Desired to know if some LEDs | 
|  | 49 | // are changing state and not really getting DeAsserted | 
| Patrick Williams | 158b2c1 | 2022-03-17 05:57:44 -0500 | [diff] [blame] | 50 | ActionSet ledsTransient{}; | 
| Patrick Venture | 91ac8d3 | 2018-11-01 17:03:22 -0700 | [diff] [blame] | 51 | std::set_intersection( | 
|  | 52 | transient.begin(), transient.end(), desiredState.begin(), | 
|  | 53 | desiredState.end(), | 
|  | 54 | std::inserter(ledsTransient, ledsTransient.begin()), ledLess); | 
| Vishwanatha Subbanna | 4c8c72b | 2016-11-29 23:02:06 +0530 | [diff] [blame] | 55 |  | 
| Vishwanatha Subbanna | 4b000d8 | 2017-05-03 18:44:16 +0530 | [diff] [blame] | 56 | // Find difference between above 2 to identify those LEDs which are | 
|  | 57 | // really getting DeAsserted | 
| Patrick Venture | 91ac8d3 | 2018-11-01 17:03:22 -0700 | [diff] [blame] | 58 | std::set_difference(transient.begin(), transient.end(), | 
|  | 59 | ledsTransient.begin(), ledsTransient.end(), | 
| Vishwanatha Subbanna | 447d0c8 | 2016-12-19 14:12:42 +0530 | [diff] [blame] | 60 | std::inserter(ledsDeAssert, ledsDeAssert.begin()), | 
| Vishwanatha Subbanna | 4b000d8 | 2017-05-03 18:44:16 +0530 | [diff] [blame] | 61 | ledLess); | 
| Vishwanatha Subbanna | 447d0c8 | 2016-12-19 14:12:42 +0530 | [diff] [blame] | 62 |  | 
| Vishwanatha Subbanna | 4b000d8 | 2017-05-03 18:44:16 +0530 | [diff] [blame] | 63 | // Remove the elements from Current that are being DeAsserted. | 
| Patrick Venture | 91ac8d3 | 2018-11-01 17:03:22 -0700 | [diff] [blame] | 64 | if (ledsDeAssert.size()) | 
| Vishwanatha Subbanna | 4b000d8 | 2017-05-03 18:44:16 +0530 | [diff] [blame] | 65 | { | 
|  | 66 | // Power off LEDs that are to be really DeAsserted | 
| Patrick Venture | 91ac8d3 | 2018-11-01 17:03:22 -0700 | [diff] [blame] | 67 | for (auto& it : ledsDeAssert) | 
| Vishwanatha Subbanna | 4b000d8 | 2017-05-03 18:44:16 +0530 | [diff] [blame] | 68 | { | 
|  | 69 | // Update LEDs in "physically asserted" set by removing those | 
|  | 70 | // LEDs which are De-Asserted | 
|  | 71 | auto found = currentState.find(it); | 
|  | 72 | if (found != currentState.end()) | 
|  | 73 | { | 
|  | 74 | currentState.erase(found); | 
|  | 75 | } | 
|  | 76 | } | 
|  | 77 | } | 
| Vishwanatha Subbanna | 4c8c72b | 2016-11-29 23:02:06 +0530 | [diff] [blame] | 78 | } | 
|  | 79 |  | 
| Vishwanatha Subbanna | 4b000d8 | 2017-05-03 18:44:16 +0530 | [diff] [blame] | 80 | // Now LEDs that are to be Asserted. These could either be fresh asserts | 
|  | 81 | // -or- change between [On]<-->[Blink] | 
| Patrick Williams | 158b2c1 | 2022-03-17 05:57:44 -0500 | [diff] [blame] | 82 | ActionSet temp{}; | 
| Vishwanatha Subbanna | 4b000d8 | 2017-05-03 18:44:16 +0530 | [diff] [blame] | 83 | std::unique_copy(desiredState.begin(), desiredState.end(), | 
| Patrick Venture | 91ac8d3 | 2018-11-01 17:03:22 -0700 | [diff] [blame] | 84 | std::inserter(temp, temp.begin()), ledEqual); | 
|  | 85 | if (temp.size()) | 
| Vishwanatha Subbanna | 4b000d8 | 2017-05-03 18:44:16 +0530 | [diff] [blame] | 86 | { | 
|  | 87 | // Find difference between [desired to be Asserted] and those LEDs | 
|  | 88 | // that are physically asserted currently. | 
| Patrick Venture | 91ac8d3 | 2018-11-01 17:03:22 -0700 | [diff] [blame] | 89 | std::set_difference( | 
|  | 90 | temp.begin(), temp.end(), currentState.begin(), currentState.end(), | 
|  | 91 | std::inserter(ledsAssert, ledsAssert.begin()), ledComp); | 
| Vishwanatha Subbanna | 4b000d8 | 2017-05-03 18:44:16 +0530 | [diff] [blame] | 92 | } | 
| Vishwanatha Subbanna | 4c8c72b | 2016-11-29 23:02:06 +0530 | [diff] [blame] | 93 |  | 
| Vishwanatha Subbanna | 4b000d8 | 2017-05-03 18:44:16 +0530 | [diff] [blame] | 94 | // Update the current actual and desired(the virtual actual) | 
|  | 95 | currentState = std::move(temp); | 
|  | 96 | combinedState = std::move(desiredState); | 
| Vishwanatha Subbanna | ed49073 | 2016-12-20 15:59:29 +0530 | [diff] [blame] | 97 |  | 
|  | 98 | // If we survive, then set the state accordingly. | 
|  | 99 | return assert; | 
|  | 100 | } | 
|  | 101 |  | 
| George Liu | b615162 | 2020-11-23 18:16:18 +0800 | [diff] [blame] | 102 | void Manager::setLampTestCallBack( | 
| Patrick Williams | 158b2c1 | 2022-03-17 05:57:44 -0500 | [diff] [blame] | 103 | std::function<bool(ActionSet& ledsAssert, ActionSet& ledsDeAssert)> | 
|  | 104 | callBack) | 
| George Liu | b615162 | 2020-11-23 18:16:18 +0800 | [diff] [blame] | 105 | { | 
|  | 106 | lampTestCallBack = callBack; | 
|  | 107 | } | 
|  | 108 |  | 
| Vishwanatha Subbanna | ed49073 | 2016-12-20 15:59:29 +0530 | [diff] [blame] | 109 | /** @brief Run through the map and apply action on the LEDs */ | 
| Patrick Williams | 158b2c1 | 2022-03-17 05:57:44 -0500 | [diff] [blame] | 110 | void Manager::driveLEDs(ActionSet& ledsAssert, ActionSet& ledsDeAssert) | 
| Vishwanatha Subbanna | ed49073 | 2016-12-20 15:59:29 +0530 | [diff] [blame] | 111 | { | 
| George Liu | b615162 | 2020-11-23 18:16:18 +0800 | [diff] [blame] | 112 | #ifdef USE_LAMP_TEST | 
|  | 113 | // Use the lampTestCallBack method and trigger the callback method in the | 
|  | 114 | // lamp test(processLEDUpdates), in this way, all lamp test operations | 
|  | 115 | // are performed in the lamp test class. | 
|  | 116 | if (lampTestCallBack(ledsAssert, ledsDeAssert)) | 
|  | 117 | { | 
|  | 118 | return; | 
|  | 119 | } | 
|  | 120 | #endif | 
| Potin Lai | f1ed479 | 2023-07-13 18:45:14 +0800 | [diff] [blame] | 121 | ActionSet newReqChangedLeds; | 
|  | 122 | std::vector<std::pair<ActionSet&, ActionSet&>> actionsVec = { | 
|  | 123 | {reqLedsAssert, ledsAssert}, {reqLedsDeAssert, ledsDeAssert}}; | 
|  | 124 |  | 
|  | 125 | timer.setEnabled(false); | 
|  | 126 | std::set_union(ledsAssert.begin(), ledsAssert.end(), ledsDeAssert.begin(), | 
|  | 127 | ledsDeAssert.end(), | 
|  | 128 | std::inserter(newReqChangedLeds, newReqChangedLeds.begin()), | 
|  | 129 | ledLess); | 
|  | 130 |  | 
|  | 131 | // prepare reqLedsAssert & reqLedsDeAssert | 
|  | 132 | for (auto pair : actionsVec) | 
| Vishwanatha Subbanna | ed49073 | 2016-12-20 15:59:29 +0530 | [diff] [blame] | 133 | { | 
| Potin Lai | f1ed479 | 2023-07-13 18:45:14 +0800 | [diff] [blame] | 134 | ActionSet tmpSet; | 
|  | 135 |  | 
|  | 136 | // Discard current required LED actions, if these LEDs have new actions | 
|  | 137 | // in newReqChangedLeds. | 
|  | 138 | std::set_difference(pair.first.begin(), pair.first.end(), | 
|  | 139 | newReqChangedLeds.begin(), newReqChangedLeds.end(), | 
|  | 140 | std::inserter(tmpSet, tmpSet.begin()), ledLess); | 
|  | 141 |  | 
|  | 142 | // Union the remaining LED actions with new LED actions. | 
|  | 143 | pair.first.clear(); | 
|  | 144 | std::set_union(tmpSet.begin(), tmpSet.end(), pair.second.begin(), | 
|  | 145 | pair.second.end(), | 
|  | 146 | std::inserter(pair.first, pair.first.begin()), ledLess); | 
| Vishwanatha Subbanna | ed49073 | 2016-12-20 15:59:29 +0530 | [diff] [blame] | 147 | } | 
|  | 148 |  | 
| Potin Lai | f1ed479 | 2023-07-13 18:45:14 +0800 | [diff] [blame] | 149 | driveLedsHandler(); | 
| Vishwanatha Subbanna | 4c8c72b | 2016-11-29 23:02:06 +0530 | [diff] [blame] | 150 | return; | 
|  | 151 | } | 
|  | 152 |  | 
| Vishwanatha Subbanna | 11ca8f9 | 2017-02-27 19:33:45 +0530 | [diff] [blame] | 153 | // Calls into driving physical LED post choosing the action | 
| Potin Lai | f1ed479 | 2023-07-13 18:45:14 +0800 | [diff] [blame] | 154 | int Manager::drivePhysicalLED(const std::string& objPath, Layout::Action action, | 
|  | 155 | uint8_t dutyOn, const uint16_t period) | 
| Vishwanatha Subbanna | 11ca8f9 | 2017-02-27 19:33:45 +0530 | [diff] [blame] | 156 | { | 
| George Liu | 1c737af | 2020-10-16 09:07:02 +0800 | [diff] [blame] | 157 | try | 
| Vishwanatha Subbanna | 11ca8f9 | 2017-02-27 19:33:45 +0530 | [diff] [blame] | 158 | { | 
| George Liu | 1c737af | 2020-10-16 09:07:02 +0800 | [diff] [blame] | 159 | // If Blink, set its property | 
|  | 160 | if (action == Layout::Action::Blink) | 
|  | 161 | { | 
|  | 162 | PropertyValue dutyOnValue{dutyOn}; | 
|  | 163 | PropertyValue periodValue{period}; | 
|  | 164 |  | 
| George Liu | 1f0b715 | 2023-07-18 09:24:34 +0800 | [diff] [blame] | 165 | dBusHandler.setProperty(objPath, phyLedIntf, "DutyOn", dutyOnValue); | 
|  | 166 | dBusHandler.setProperty(objPath, phyLedIntf, "Period", periodValue); | 
| George Liu | 1c737af | 2020-10-16 09:07:02 +0800 | [diff] [blame] | 167 | } | 
|  | 168 |  | 
|  | 169 | PropertyValue actionValue{getPhysicalAction(action)}; | 
| George Liu | 1f0b715 | 2023-07-18 09:24:34 +0800 | [diff] [blame] | 170 | dBusHandler.setProperty(objPath, phyLedIntf, "State", actionValue); | 
| George Liu | 1c737af | 2020-10-16 09:07:02 +0800 | [diff] [blame] | 171 | } | 
| George Liu | 829c0b3 | 2023-07-18 10:00:47 +0800 | [diff] [blame] | 172 | catch (const sdbusplus::exception_t& e) | 
| George Liu | 1c737af | 2020-10-16 09:07:02 +0800 | [diff] [blame] | 173 | { | 
| George Liu | e9fb5c6 | 2021-07-01 14:05:32 +0800 | [diff] [blame] | 174 | lg2::error( | 
|  | 175 | "Error setting property for physical LED, ERROR = {ERROR}, OBJECT_PATH = {PATH}", | 
|  | 176 | "ERROR", e, "PATH", objPath); | 
| Potin Lai | f1ed479 | 2023-07-13 18:45:14 +0800 | [diff] [blame] | 177 | return -1; | 
| Vishwanatha Subbanna | 11ca8f9 | 2017-02-27 19:33:45 +0530 | [diff] [blame] | 178 | } | 
| Vishwanatha Subbanna | dcc3f38 | 2017-03-24 20:15:02 +0530 | [diff] [blame] | 179 |  | 
| Potin Lai | f1ed479 | 2023-07-13 18:45:14 +0800 | [diff] [blame] | 180 | return 0; | 
| Vishwanatha Subbanna | 11ca8f9 | 2017-02-27 19:33:45 +0530 | [diff] [blame] | 181 | } | 
|  | 182 |  | 
|  | 183 | /** @brief Returns action string based on enum */ | 
| Vishwanatha Subbanna | 4fa9248 | 2017-03-10 14:39:20 +0530 | [diff] [blame] | 184 | std::string Manager::getPhysicalAction(Layout::Action action) | 
| Vishwanatha Subbanna | 11ca8f9 | 2017-02-27 19:33:45 +0530 | [diff] [blame] | 185 | { | 
| Vishwanatha Subbanna | 4fa9248 | 2017-03-10 14:39:20 +0530 | [diff] [blame] | 186 | namespace server = sdbusplus::xyz::openbmc_project::Led::server; | 
|  | 187 |  | 
|  | 188 | // TODO: openbmc/phosphor-led-manager#5 | 
|  | 189 | //    Somehow need to use the generated Action enum than giving one | 
|  | 190 | //    in ledlayout. | 
| Patrick Venture | 91ac8d3 | 2018-11-01 17:03:22 -0700 | [diff] [blame] | 191 | if (action == Layout::Action::On) | 
| Vishwanatha Subbanna | 11ca8f9 | 2017-02-27 19:33:45 +0530 | [diff] [blame] | 192 | { | 
| Vishwanatha Subbanna | 4fa9248 | 2017-03-10 14:39:20 +0530 | [diff] [blame] | 193 | return server::convertForMessage(server::Physical::Action::On); | 
| Vishwanatha Subbanna | 11ca8f9 | 2017-02-27 19:33:45 +0530 | [diff] [blame] | 194 | } | 
| Patrick Venture | 91ac8d3 | 2018-11-01 17:03:22 -0700 | [diff] [blame] | 195 | else if (action == Layout::Action::Blink) | 
| Vishwanatha Subbanna | 11ca8f9 | 2017-02-27 19:33:45 +0530 | [diff] [blame] | 196 | { | 
| Vishwanatha Subbanna | 4fa9248 | 2017-03-10 14:39:20 +0530 | [diff] [blame] | 197 | return server::convertForMessage(server::Physical::Action::Blink); | 
| Vishwanatha Subbanna | 11ca8f9 | 2017-02-27 19:33:45 +0530 | [diff] [blame] | 198 | } | 
|  | 199 | else | 
|  | 200 | { | 
| Vishwanatha Subbanna | 4fa9248 | 2017-03-10 14:39:20 +0530 | [diff] [blame] | 201 | return server::convertForMessage(server::Physical::Action::Off); | 
| Vishwanatha Subbanna | 11ca8f9 | 2017-02-27 19:33:45 +0530 | [diff] [blame] | 202 | } | 
|  | 203 | } | 
|  | 204 |  | 
| Potin Lai | f1ed479 | 2023-07-13 18:45:14 +0800 | [diff] [blame] | 205 | void Manager::driveLedsHandler(void) | 
|  | 206 | { | 
|  | 207 | ActionSet failedLedsAssert; | 
|  | 208 | ActionSet failedLedsDeAssert; | 
|  | 209 |  | 
|  | 210 | // This order of LED operation is important. | 
|  | 211 | if (reqLedsDeAssert.size()) | 
|  | 212 | { | 
|  | 213 | for (const auto& it : reqLedsDeAssert) | 
|  | 214 | { | 
|  | 215 | std::string objPath = std::string(phyLedPath) + it.name; | 
|  | 216 | lg2::debug("De-Asserting LED, NAME = {NAME}, ACTION = {ACTION}", | 
|  | 217 | "NAME", it.name, "ACTION", it.action); | 
|  | 218 | if (drivePhysicalLED(objPath, Layout::Action::Off, it.dutyOn, | 
|  | 219 | it.period)) | 
|  | 220 | { | 
|  | 221 | failedLedsDeAssert.insert(it); | 
|  | 222 | } | 
|  | 223 | } | 
|  | 224 | } | 
|  | 225 |  | 
|  | 226 | if (reqLedsAssert.size()) | 
|  | 227 | { | 
|  | 228 | for (const auto& it : reqLedsAssert) | 
|  | 229 | { | 
|  | 230 | std::string objPath = std::string(phyLedPath) + it.name; | 
|  | 231 | lg2::debug("Asserting LED, NAME = {NAME}, ACTION = {ACTION}", | 
|  | 232 | "NAME", it.name, "ACTION", it.action); | 
|  | 233 | if (drivePhysicalLED(objPath, it.action, it.dutyOn, it.period)) | 
|  | 234 | { | 
|  | 235 | failedLedsAssert.insert(it); | 
|  | 236 | } | 
|  | 237 | } | 
|  | 238 | } | 
|  | 239 |  | 
|  | 240 | reqLedsAssert = failedLedsAssert; | 
|  | 241 | reqLedsDeAssert = failedLedsDeAssert; | 
|  | 242 |  | 
|  | 243 | if (reqLedsDeAssert.empty() && reqLedsAssert.empty()) | 
|  | 244 | { | 
|  | 245 | timer.setEnabled(false); | 
|  | 246 | } | 
|  | 247 | else | 
|  | 248 | { | 
|  | 249 | timer.restartOnce(std::chrono::seconds(1)); | 
|  | 250 | } | 
|  | 251 |  | 
|  | 252 | return; | 
|  | 253 | } | 
|  | 254 |  | 
| Vishwanatha Subbanna | 4c8c72b | 2016-11-29 23:02:06 +0530 | [diff] [blame] | 255 | } // namespace led | 
|  | 256 | } // namespace phosphor |