1 #include "config.h"
2 
3 #include "sensorhandler.hpp"
4 
5 #include "entity_map_json.hpp"
6 #include "fruread.hpp"
7 
8 #include <mapper.h>
9 #include <systemd/sd-bus.h>
10 
11 #include <bitset>
12 #include <cmath>
13 #include <cstring>
14 #include <ipmid/api.hpp>
15 #include <ipmid/types.hpp>
16 #include <ipmid/utils.hpp>
17 #include <phosphor-logging/elog-errors.hpp>
18 #include <phosphor-logging/log.hpp>
19 #include <sdbusplus/message/types.hpp>
20 #include <set>
21 #include <xyz/openbmc_project/Common/error.hpp>
22 #include <xyz/openbmc_project/Sensor/Value/server.hpp>
23 
24 static constexpr uint8_t fruInventoryDevice = 0x10;
25 static constexpr uint8_t IPMIFruInventory = 0x02;
26 static constexpr uint8_t BMCSlaveAddress = 0x20;
27 
28 extern int updateSensorRecordFromSSRAESC(const void*);
29 extern sd_bus* bus;
30 
31 namespace ipmi
32 {
33 namespace sensor
34 {
35 extern const IdInfoMap sensors;
36 } // namespace sensor
37 } // namespace ipmi
38 
39 extern const FruMap frus;
40 
41 using namespace phosphor::logging;
42 using InternalFailure =
43     sdbusplus::xyz::openbmc_project::Common::Error::InternalFailure;
44 
45 void register_netfn_sen_functions() __attribute__((constructor));
46 
47 struct sensorTypemap_t
48 {
49     uint8_t number;
50     uint8_t typecode;
51     char dbusname[32];
52 };
53 
54 sensorTypemap_t g_SensorTypeMap[] = {
55 
56     {0x01, 0x6F, "Temp"},
57     {0x0C, 0x6F, "DIMM"},
58     {0x0C, 0x6F, "MEMORY_BUFFER"},
59     {0x07, 0x6F, "PROC"},
60     {0x07, 0x6F, "CORE"},
61     {0x07, 0x6F, "CPU"},
62     {0x0F, 0x6F, "BootProgress"},
63     {0xe9, 0x09, "OccStatus"}, // E9 is an internal mapping to handle sensor
64                                // type code os 0x09
65     {0xC3, 0x6F, "BootCount"},
66     {0x1F, 0x6F, "OperatingSystemStatus"},
67     {0x12, 0x6F, "SYSTEM_EVENT"},
68     {0xC7, 0x03, "SYSTEM"},
69     {0xC7, 0x03, "MAIN_PLANAR"},
70     {0xC2, 0x6F, "PowerCap"},
71     {0x0b, 0xCA, "PowerSupplyRedundancy"},
72     {0xDA, 0x03, "TurboAllowed"},
73     {0xD8, 0xC8, "PowerSupplyDerating"},
74     {0xFF, 0x00, ""},
75 };
76 
77 struct sensor_data_t
78 {
79     uint8_t sennum;
80 } __attribute__((packed));
81 
82 struct sensorreadingresp_t
83 {
84     uint8_t value;
85     uint8_t operation;
86     uint8_t indication[2];
87 } __attribute__((packed));
88 
89 int get_bus_for_path(const char* path, char** busname)
90 {
91     return mapper_get_service(bus, path, busname);
92 }
93 
94 // Use a lookup table to find the interface name of a specific sensor
95 // This will be used until an alternative is found.  this is the first
96 // step for mapping IPMI
97 int find_openbmc_path(uint8_t num, dbus_interface_t* interface)
98 {
99     int rc;
100 
101     const auto& sensor_it = ipmi::sensor::sensors.find(num);
102     if (sensor_it == ipmi::sensor::sensors.end())
103     {
104         // The sensor map does not contain the sensor requested
105         return -EINVAL;
106     }
107 
108     const auto& info = sensor_it->second;
109 
110     char* busname = nullptr;
111     rc = get_bus_for_path(info.sensorPath.c_str(), &busname);
112     if (rc < 0)
113     {
114         std::fprintf(stderr, "Failed to get %s busname: %s\n",
115                      info.sensorPath.c_str(), busname);
116         goto final;
117     }
118 
119     interface->sensortype = info.sensorType;
120     strcpy(interface->bus, busname);
121     strcpy(interface->path, info.sensorPath.c_str());
122     // Take the interface name from the beginning of the DbusInterfaceMap. This
123     // works for the Value interface but may not suffice for more complex
124     // sensors.
125     // tracked https://github.com/openbmc/phosphor-host-ipmid/issues/103
126     strcpy(interface->interface,
127            info.propertyInterfaces.begin()->first.c_str());
128     interface->sensornumber = num;
129 
130 final:
131     free(busname);
132     return rc;
133 }
134 
135 /////////////////////////////////////////////////////////////////////
136 //
137 // Routines used by ipmi commands wanting to interact on the dbus
138 //
139 /////////////////////////////////////////////////////////////////////
140 int set_sensor_dbus_state_s(uint8_t number, const char* method,
141                             const char* value)
142 {
143 
144     dbus_interface_t a;
145     int r;
146     sd_bus_error error = SD_BUS_ERROR_NULL;
147     sd_bus_message* m = NULL;
148 
149     r = find_openbmc_path(number, &a);
150 
151     if (r < 0)
152     {
153         std::fprintf(stderr, "Failed to find Sensor 0x%02x\n", number);
154         return 0;
155     }
156 
157     r = sd_bus_message_new_method_call(bus, &m, a.bus, a.path, a.interface,
158                                        method);
159     if (r < 0)
160     {
161         std::fprintf(stderr, "Failed to create a method call: %s",
162                      strerror(-r));
163         goto final;
164     }
165 
166     r = sd_bus_message_append(m, "v", "s", value);
167     if (r < 0)
168     {
169         std::fprintf(stderr, "Failed to create a input parameter: %s",
170                      strerror(-r));
171         goto final;
172     }
173 
174     r = sd_bus_call(bus, m, 0, &error, NULL);
175     if (r < 0)
176     {
177         std::fprintf(stderr, "Failed to call the method: %s", strerror(-r));
178     }
179 
180 final:
181     sd_bus_error_free(&error);
182     m = sd_bus_message_unref(m);
183 
184     return 0;
185 }
186 int set_sensor_dbus_state_y(uint8_t number, const char* method,
187                             const uint8_t value)
188 {
189 
190     dbus_interface_t a;
191     int r;
192     sd_bus_error error = SD_BUS_ERROR_NULL;
193     sd_bus_message* m = NULL;
194 
195     r = find_openbmc_path(number, &a);
196 
197     if (r < 0)
198     {
199         std::fprintf(stderr, "Failed to find Sensor 0x%02x\n", number);
200         return 0;
201     }
202 
203     r = sd_bus_message_new_method_call(bus, &m, a.bus, a.path, a.interface,
204                                        method);
205     if (r < 0)
206     {
207         std::fprintf(stderr, "Failed to create a method call: %s",
208                      strerror(-r));
209         goto final;
210     }
211 
212     r = sd_bus_message_append(m, "v", "i", value);
213     if (r < 0)
214     {
215         std::fprintf(stderr, "Failed to create a input parameter: %s",
216                      strerror(-r));
217         goto final;
218     }
219 
220     r = sd_bus_call(bus, m, 0, &error, NULL);
221     if (r < 0)
222     {
223         std::fprintf(stderr, "12 Failed to call the method: %s", strerror(-r));
224     }
225 
226 final:
227     sd_bus_error_free(&error);
228     m = sd_bus_message_unref(m);
229 
230     return 0;
231 }
232 
233 uint8_t dbus_to_sensor_type(char* p)
234 {
235 
236     sensorTypemap_t* s = g_SensorTypeMap;
237     char r = 0;
238     while (s->number != 0xFF)
239     {
240         if (!strcmp(s->dbusname, p))
241         {
242             r = s->typecode;
243             break;
244         }
245         s++;
246     }
247 
248     if (s->number == 0xFF)
249         printf("Failed to find Sensor Type %s\n", p);
250 
251     return r;
252 }
253 
254 uint8_t get_type_from_interface(dbus_interface_t dbus_if)
255 {
256 
257     uint8_t type;
258 
259     // This is where sensors that do not exist in dbus but do
260     // exist in the host code stop.  This should indicate it
261     // is not a supported sensor
262     if (dbus_if.interface[0] == 0)
263     {
264         return 0;
265     }
266 
267     // Fetch type from interface itself.
268     if (dbus_if.sensortype != 0)
269     {
270         type = dbus_if.sensortype;
271     }
272     else
273     {
274         // Non InventoryItems
275         char* p = strrchr(dbus_if.path, '/');
276         type = dbus_to_sensor_type(p + 1);
277     }
278 
279     return type;
280 }
281 
282 // Replaces find_sensor
283 uint8_t find_type_for_sensor_number(uint8_t num)
284 {
285     int r;
286     dbus_interface_t dbus_if;
287     r = find_openbmc_path(num, &dbus_if);
288     if (r < 0)
289     {
290         std::fprintf(stderr, "Could not find sensor %d\n", num);
291         return 0;
292     }
293     return get_type_from_interface(dbus_if);
294 }
295 
296 ipmi_ret_t ipmi_sen_get_sensor_type(ipmi_netfn_t netfn, ipmi_cmd_t cmd,
297                                     ipmi_request_t request,
298                                     ipmi_response_t response,
299                                     ipmi_data_len_t data_len,
300                                     ipmi_context_t context)
301 {
302     auto reqptr = static_cast<sensor_data_t*>(request);
303     ipmi_ret_t rc = IPMI_CC_OK;
304 
305     printf("IPMI GET_SENSOR_TYPE [0x%02X]\n", reqptr->sennum);
306 
307     // TODO Not sure what the System-event-sensor is suppose to return
308     // need to ask Hostboot team
309     unsigned char buf[] = {0x00, 0x6F};
310 
311     buf[0] = find_type_for_sensor_number(reqptr->sennum);
312 
313     // HACK UNTIL Dbus gets updated or we find a better way
314     if (buf[0] == 0)
315     {
316         rc = IPMI_CC_SENSOR_INVALID;
317     }
318 
319     *data_len = sizeof(buf);
320     std::memcpy(response, &buf, *data_len);
321 
322     return rc;
323 }
324 
325 const std::set<std::string> analogSensorInterfaces = {
326     "xyz.openbmc_project.Sensor.Value",
327     "xyz.openbmc_project.Control.FanPwm",
328 };
329 
330 bool isAnalogSensor(const std::string& interface)
331 {
332     return (analogSensorInterfaces.count(interface));
333 }
334 
335 /**
336 @brief This command is used to set sensorReading.
337 
338 @param
339     -  sensorNumber
340     -  operation
341     -  reading
342     -  assertOffset0_7
343     -  assertOffset8_14
344     -  deassertOffset0_7
345     -  deassertOffset8_14
346     -  eventData1
347     -  eventData2
348     -  eventData3
349 
350 @return completion code on success.
351 **/
352 
353 ipmi::RspType<> ipmiSetSensorReading(uint8_t sensorNumber, uint8_t operation,
354                                      uint8_t reading, uint8_t assertOffset0_7,
355                                      uint8_t assertOffset8_14,
356                                      uint8_t deassertOffset0_7,
357                                      uint8_t deassertOffset8_14,
358                                      uint8_t eventData1, uint8_t eventData2,
359                                      uint8_t eventData3)
360 {
361     log<level::DEBUG>("IPMI SET_SENSOR",
362                       entry("SENSOR_NUM=0x%02x", sensorNumber));
363 
364     ipmi::sensor::SetSensorReadingReq cmdData;
365 
366     cmdData.number = sensorNumber;
367     cmdData.operation = operation;
368     cmdData.reading = reading;
369     cmdData.assertOffset0_7 = assertOffset0_7;
370     cmdData.assertOffset8_14 = assertOffset8_14;
371     cmdData.deassertOffset0_7 = deassertOffset0_7;
372     cmdData.deassertOffset8_14 = deassertOffset8_14;
373     cmdData.eventData1 = eventData1;
374     cmdData.eventData2 = eventData2;
375     cmdData.eventData3 = eventData3;
376 
377     // Check if the Sensor Number is present
378     const auto iter = ipmi::sensor::sensors.find(sensorNumber);
379     if (iter == ipmi::sensor::sensors.end())
380     {
381         updateSensorRecordFromSSRAESC(&sensorNumber);
382         return ipmi::responseSuccess();
383     }
384 
385     try
386     {
387         if (ipmi::sensor::Mutability::Write !=
388             (iter->second.mutability & ipmi::sensor::Mutability::Write))
389         {
390             log<level::ERR>("Sensor Set operation is not allowed",
391                             entry("SENSOR_NUM=%d", sensorNumber));
392             return ipmi::responseIllegalCommand();
393         }
394         auto ipmiRC = iter->second.updateFunc(cmdData, iter->second);
395         return ipmi::response(ipmiRC);
396     }
397     catch (InternalFailure& e)
398     {
399         log<level::ERR>("Set sensor failed",
400                         entry("SENSOR_NUM=%d", sensorNumber));
401         commit<InternalFailure>();
402         return ipmi::responseUnspecifiedError();
403     }
404     catch (const std::runtime_error& e)
405     {
406         log<level::ERR>(e.what());
407         return ipmi::responseUnspecifiedError();
408     }
409 }
410 
411 ipmi_ret_t ipmi_sen_get_sensor_reading(ipmi_netfn_t netfn, ipmi_cmd_t cmd,
412                                        ipmi_request_t request,
413                                        ipmi_response_t response,
414                                        ipmi_data_len_t data_len,
415                                        ipmi_context_t context)
416 {
417     auto reqptr = static_cast<sensor_data_t*>(request);
418     auto resp = static_cast<sensorreadingresp_t*>(response);
419     ipmi::sensor::GetSensorResponse getResponse{};
420     static constexpr auto scanningEnabledBit = 6;
421 
422     const auto iter = ipmi::sensor::sensors.find(reqptr->sennum);
423     if (iter == ipmi::sensor::sensors.end())
424     {
425         return IPMI_CC_SENSOR_INVALID;
426     }
427     if (ipmi::sensor::Mutability::Read !=
428         (iter->second.mutability & ipmi::sensor::Mutability::Read))
429     {
430         return IPMI_CC_ILLEGAL_COMMAND;
431     }
432 
433     try
434     {
435         getResponse = iter->second.getFunc(iter->second);
436         *data_len = getResponse.size();
437         std::memcpy(resp, getResponse.data(), *data_len);
438         resp->operation = 1 << scanningEnabledBit;
439         return IPMI_CC_OK;
440     }
441 #ifdef UPDATE_FUNCTIONAL_ON_FAIL
442     catch (const SensorFunctionalError& e)
443     {
444         return IPMI_CC_RESPONSE_ERROR;
445     }
446 #endif
447     catch (const std::exception& e)
448     {
449         *data_len = getResponse.size();
450         std::memcpy(resp, getResponse.data(), *data_len);
451         return IPMI_CC_OK;
452     }
453 }
454 
455 void getSensorThresholds(uint8_t sensorNum,
456                          get_sdr::GetSensorThresholdsResponse* response)
457 {
458     constexpr auto warningThreshIntf =
459         "xyz.openbmc_project.Sensor.Threshold.Warning";
460     constexpr auto criticalThreshIntf =
461         "xyz.openbmc_project.Sensor.Threshold.Critical";
462 
463     sdbusplus::bus::bus bus{ipmid_get_sd_bus_connection()};
464 
465     const auto iter = ipmi::sensor::sensors.find(sensorNum);
466     const auto info = iter->second;
467 
468     auto service = ipmi::getService(bus, info.sensorInterface, info.sensorPath);
469 
470     auto warnThresholds = ipmi::getAllDbusProperties(
471         bus, service, info.sensorPath, warningThreshIntf);
472 
473     double warnLow = std::visit(ipmi::VariantToDoubleVisitor(),
474                                 warnThresholds["WarningLow"]);
475     double warnHigh = std::visit(ipmi::VariantToDoubleVisitor(),
476                                  warnThresholds["WarningHigh"]);
477 
478     if (warnLow != 0)
479     {
480         warnLow *= std::pow(10, info.scale - info.exponentR);
481         response->lowerNonCritical = static_cast<uint8_t>(
482             (warnLow - info.scaledOffset) / info.coefficientM);
483         response->validMask |= static_cast<uint8_t>(
484             ipmi::sensor::ThresholdMask::NON_CRITICAL_LOW_MASK);
485     }
486 
487     if (warnHigh != 0)
488     {
489         warnHigh *= std::pow(10, info.scale - info.exponentR);
490         response->upperNonCritical = static_cast<uint8_t>(
491             (warnHigh - info.scaledOffset) / info.coefficientM);
492         response->validMask |= static_cast<uint8_t>(
493             ipmi::sensor::ThresholdMask::NON_CRITICAL_HIGH_MASK);
494     }
495 
496     auto critThresholds = ipmi::getAllDbusProperties(
497         bus, service, info.sensorPath, criticalThreshIntf);
498     double critLow = std::visit(ipmi::VariantToDoubleVisitor(),
499                                 critThresholds["CriticalLow"]);
500     double critHigh = std::visit(ipmi::VariantToDoubleVisitor(),
501                                  critThresholds["CriticalHigh"]);
502 
503     if (critLow != 0)
504     {
505         critLow *= std::pow(10, info.scale - info.exponentR);
506         response->lowerCritical = static_cast<uint8_t>(
507             (critLow - info.scaledOffset) / info.coefficientM);
508         response->validMask |= static_cast<uint8_t>(
509             ipmi::sensor::ThresholdMask::CRITICAL_LOW_MASK);
510     }
511 
512     if (critHigh != 0)
513     {
514         critHigh *= std::pow(10, info.scale - info.exponentR);
515         response->upperCritical = static_cast<uint8_t>(
516             (critHigh - info.scaledOffset) / info.coefficientM);
517         response->validMask |= static_cast<uint8_t>(
518             ipmi::sensor::ThresholdMask::CRITICAL_HIGH_MASK);
519     }
520 }
521 
522 ipmi_ret_t ipmi_sen_get_sensor_thresholds(ipmi_netfn_t netfn, ipmi_cmd_t cmd,
523                                           ipmi_request_t request,
524                                           ipmi_response_t response,
525                                           ipmi_data_len_t data_len,
526                                           ipmi_context_t context)
527 {
528     constexpr auto valueInterface = "xyz.openbmc_project.Sensor.Value";
529 
530     if (*data_len != sizeof(uint8_t))
531     {
532         *data_len = 0;
533         return IPMI_CC_REQ_DATA_LEN_INVALID;
534     }
535 
536     auto sensorNum = *(reinterpret_cast<const uint8_t*>(request));
537     *data_len = 0;
538 
539     const auto iter = ipmi::sensor::sensors.find(sensorNum);
540     if (iter == ipmi::sensor::sensors.end())
541     {
542         return IPMI_CC_SENSOR_INVALID;
543     }
544 
545     const auto info = iter->second;
546 
547     // Proceed only if the sensor value interface is implemented.
548     if (info.propertyInterfaces.find(valueInterface) ==
549         info.propertyInterfaces.end())
550     {
551         // return with valid mask as 0
552         return IPMI_CC_OK;
553     }
554 
555     auto responseData =
556         reinterpret_cast<get_sdr::GetSensorThresholdsResponse*>(response);
557 
558     try
559     {
560         getSensorThresholds(sensorNum, responseData);
561     }
562     catch (std::exception& e)
563     {
564         // Mask if the property is not present
565         responseData->validMask = 0;
566     }
567 
568     *data_len = sizeof(get_sdr::GetSensorThresholdsResponse);
569     return IPMI_CC_OK;
570 }
571 
572 ipmi_ret_t ipmi_sen_wildcard(ipmi_netfn_t netfn, ipmi_cmd_t cmd,
573                              ipmi_request_t request, ipmi_response_t response,
574                              ipmi_data_len_t data_len, ipmi_context_t context)
575 {
576     ipmi_ret_t rc = IPMI_CC_INVALID;
577 
578     printf("IPMI S/E Wildcard Netfn:[0x%X], Cmd:[0x%X]\n", netfn, cmd);
579     *data_len = 0;
580 
581     return rc;
582 }
583 
584 /** @brief implements the get SDR Info command
585  *  @param count - Operation
586  *
587  *  @returns IPMI completion code plus response data
588  *   - sdrCount - sensor/SDR count
589  *   - lunsAndDynamicPopulation - static/Dynamic sensor population flag
590  */
591 ipmi::RspType<uint8_t, // respcount
592               uint8_t  // dynamic population flags
593               >
594     ipmiSensorGetDeviceSdrInfo(std::optional<uint8_t> count)
595 {
596     uint8_t sdrCount;
597     // multiple LUNs not supported.
598     constexpr uint8_t lunsAndDynamicPopulation = 1;
599     constexpr uint8_t getSdrCount = 0x01;
600     constexpr uint8_t getSensorCount = 0x00;
601 
602     if (count.value_or(0) == getSdrCount)
603     {
604         // Get SDR count. This returns the total number of SDRs in the device.
605         const auto& entityRecords =
606             ipmi::sensor::EntityInfoMapContainer::getContainer()
607                 ->getIpmiEntityRecords();
608         sdrCount =
609             ipmi::sensor::sensors.size() + frus.size() + entityRecords.size();
610     }
611     else if (count.value_or(0) == getSensorCount)
612     {
613         // Get Sensor count. This returns the number of sensors
614         sdrCount = ipmi::sensor::sensors.size();
615     }
616     else
617     {
618         return ipmi::responseInvalidCommandOnLun();
619     }
620 
621     return ipmi::responseSuccess(sdrCount, lunsAndDynamicPopulation);
622 }
623 
624 /** @brief implements the reserve SDR command
625  *  @returns IPMI completion code plus response data
626  *   - reservationID - reservation ID
627  */
628 ipmi::RspType<uint16_t> ipmiSensorReserveSdr()
629 {
630     // A constant reservation ID is okay until we implement add/remove SDR.
631     constexpr uint16_t reservationID = 1;
632 
633     return ipmi::responseSuccess(reservationID);
634 }
635 
636 void setUnitFieldsForObject(const ipmi::sensor::Info* info,
637                             get_sdr::SensorDataFullRecordBody* body)
638 {
639     namespace server = sdbusplus::xyz::openbmc_project::Sensor::server;
640     try
641     {
642         auto unit = server::Value::convertUnitFromString(info->unit);
643         // Unit strings defined in
644         // phosphor-dbus-interfaces/xyz/openbmc_project/Sensor/Value.interface.yaml
645         switch (unit)
646         {
647             case server::Value::Unit::DegreesC:
648                 body->sensor_units_2_base = get_sdr::SENSOR_UNIT_DEGREES_C;
649                 break;
650             case server::Value::Unit::RPMS:
651                 body->sensor_units_2_base = get_sdr::SENSOR_UNIT_RPM;
652                 break;
653             case server::Value::Unit::Volts:
654                 body->sensor_units_2_base = get_sdr::SENSOR_UNIT_VOLTS;
655                 break;
656             case server::Value::Unit::Meters:
657                 body->sensor_units_2_base = get_sdr::SENSOR_UNIT_METERS;
658                 break;
659             case server::Value::Unit::Amperes:
660                 body->sensor_units_2_base = get_sdr::SENSOR_UNIT_AMPERES;
661                 break;
662             case server::Value::Unit::Joules:
663                 body->sensor_units_2_base = get_sdr::SENSOR_UNIT_JOULES;
664                 break;
665             case server::Value::Unit::Watts:
666                 body->sensor_units_2_base = get_sdr::SENSOR_UNIT_WATTS;
667                 break;
668             default:
669                 // Cannot be hit.
670                 std::fprintf(stderr, "Unknown value unit type: = %s\n",
671                              info->unit.c_str());
672         }
673     }
674     catch (const sdbusplus::exception::InvalidEnumString& e)
675     {
676         log<level::WARNING>("Warning: no unit provided for sensor!");
677     }
678 }
679 
680 ipmi_ret_t populate_record_from_dbus(get_sdr::SensorDataFullRecordBody* body,
681                                      const ipmi::sensor::Info* info,
682                                      ipmi_data_len_t data_len)
683 {
684     /* Functional sensor case */
685     if (isAnalogSensor(info->propertyInterfaces.begin()->first))
686     {
687 
688         body->sensor_units_1 = 0; // unsigned, no rate, no modifier, not a %
689 
690         /* Unit info */
691         setUnitFieldsForObject(info, body);
692 
693         get_sdr::body::set_b(info->coefficientB, body);
694         get_sdr::body::set_m(info->coefficientM, body);
695         get_sdr::body::set_b_exp(info->exponentB, body);
696         get_sdr::body::set_r_exp(info->exponentR, body);
697 
698         get_sdr::body::set_id_type(0b00, body); // 00 = unicode
699     }
700 
701     /* ID string */
702     auto id_string = info->sensorNameFunc(*info);
703 
704     if (id_string.length() > FULL_RECORD_ID_STR_MAX_LENGTH)
705     {
706         get_sdr::body::set_id_strlen(FULL_RECORD_ID_STR_MAX_LENGTH, body);
707     }
708     else
709     {
710         get_sdr::body::set_id_strlen(id_string.length(), body);
711     }
712     strncpy(body->id_string, id_string.c_str(),
713             get_sdr::body::get_id_strlen(body));
714 
715     return IPMI_CC_OK;
716 };
717 
718 ipmi_ret_t ipmi_fru_get_sdr(ipmi_request_t request, ipmi_response_t response,
719                             ipmi_data_len_t data_len)
720 {
721     auto req = reinterpret_cast<get_sdr::GetSdrReq*>(request);
722     auto resp = reinterpret_cast<get_sdr::GetSdrResp*>(response);
723     get_sdr::SensorDataFruRecord record{};
724     auto dataLength = 0;
725 
726     auto fru = frus.begin();
727     uint8_t fruID{};
728     auto recordID = get_sdr::request::get_record_id(req);
729 
730     fruID = recordID - FRU_RECORD_ID_START;
731     fru = frus.find(fruID);
732     if (fru == frus.end())
733     {
734         return IPMI_CC_SENSOR_INVALID;
735     }
736 
737     /* Header */
738     get_sdr::header::set_record_id(recordID, &(record.header));
739     record.header.sdr_version = SDR_VERSION; // Based on IPMI Spec v2.0 rev 1.1
740     record.header.record_type = get_sdr::SENSOR_DATA_FRU_RECORD;
741     record.header.record_length = sizeof(record.key) + sizeof(record.body);
742 
743     /* Key */
744     record.key.fruID = fruID;
745     record.key.accessLun |= IPMI_LOGICAL_FRU;
746     record.key.deviceAddress = BMCSlaveAddress;
747 
748     /* Body */
749     record.body.entityID = fru->second[0].entityID;
750     record.body.entityInstance = fru->second[0].entityInstance;
751     record.body.deviceType = fruInventoryDevice;
752     record.body.deviceTypeModifier = IPMIFruInventory;
753 
754     /* Device ID string */
755     auto deviceID =
756         fru->second[0].path.substr(fru->second[0].path.find_last_of('/') + 1,
757                                    fru->second[0].path.length());
758 
759     if (deviceID.length() > get_sdr::FRU_RECORD_DEVICE_ID_MAX_LENGTH)
760     {
761         get_sdr::body::set_device_id_strlen(
762             get_sdr::FRU_RECORD_DEVICE_ID_MAX_LENGTH, &(record.body));
763     }
764     else
765     {
766         get_sdr::body::set_device_id_strlen(deviceID.length(), &(record.body));
767     }
768 
769     strncpy(record.body.deviceID, deviceID.c_str(),
770             get_sdr::body::get_device_id_strlen(&(record.body)));
771 
772     if (++fru == frus.end())
773     {
774         // we have reached till end of fru, so assign the next record id to
775         // 512(Max fru ID = 511) + Entity Record ID(may start with 0).
776         const auto& entityRecords =
777             ipmi::sensor::EntityInfoMapContainer::getContainer()
778                 ->getIpmiEntityRecords();
779         auto next_record_id =
780             (entityRecords.size())
781                 ? entityRecords.begin()->first + ENTITY_RECORD_ID_START
782                 : END_OF_RECORD;
783         get_sdr::response::set_next_record_id(next_record_id, resp);
784     }
785     else
786     {
787         get_sdr::response::set_next_record_id(
788             (FRU_RECORD_ID_START + fru->first), resp);
789     }
790 
791     // Check for invalid offset size
792     if (req->offset > sizeof(record))
793     {
794         return IPMI_CC_PARM_OUT_OF_RANGE;
795     }
796 
797     dataLength = std::min(static_cast<size_t>(req->bytes_to_read),
798                           sizeof(record) - req->offset);
799 
800     std::memcpy(resp->record_data,
801                 reinterpret_cast<uint8_t*>(&record) + req->offset, dataLength);
802 
803     *data_len = dataLength;
804     *data_len += 2; // additional 2 bytes for next record ID
805 
806     return IPMI_CC_OK;
807 }
808 
809 ipmi_ret_t ipmi_entity_get_sdr(ipmi_request_t request, ipmi_response_t response,
810                                ipmi_data_len_t data_len)
811 {
812     auto req = reinterpret_cast<get_sdr::GetSdrReq*>(request);
813     auto resp = reinterpret_cast<get_sdr::GetSdrResp*>(response);
814     get_sdr::SensorDataEntityRecord record{};
815     auto dataLength = 0;
816 
817     const auto& entityRecords =
818         ipmi::sensor::EntityInfoMapContainer::getContainer()
819             ->getIpmiEntityRecords();
820     auto entity = entityRecords.begin();
821     uint8_t entityRecordID;
822     auto recordID = get_sdr::request::get_record_id(req);
823 
824     entityRecordID = recordID - ENTITY_RECORD_ID_START;
825     entity = entityRecords.find(entityRecordID);
826     if (entity == entityRecords.end())
827     {
828         return IPMI_CC_SENSOR_INVALID;
829     }
830 
831     /* Header */
832     get_sdr::header::set_record_id(recordID, &(record.header));
833     record.header.sdr_version = SDR_VERSION; // Based on IPMI Spec v2.0 rev 1.1
834     record.header.record_type = get_sdr::SENSOR_DATA_ENTITY_RECORD;
835     record.header.record_length = sizeof(record.key) + sizeof(record.body);
836 
837     /* Key */
838     record.key.containerEntityId = entity->second.containerEntityId;
839     record.key.containerEntityInstance = entity->second.containerEntityInstance;
840     get_sdr::key::set_flags(entity->second.isList, entity->second.isLinked,
841                             &(record.key));
842     record.key.entityId1 = entity->second.containedEntities[0].first;
843     record.key.entityInstance1 = entity->second.containedEntities[0].second;
844 
845     /* Body */
846     record.body.entityId2 = entity->second.containedEntities[1].first;
847     record.body.entityInstance2 = entity->second.containedEntities[1].second;
848     record.body.entityId3 = entity->second.containedEntities[2].first;
849     record.body.entityInstance3 = entity->second.containedEntities[2].second;
850     record.body.entityId4 = entity->second.containedEntities[3].first;
851     record.body.entityInstance4 = entity->second.containedEntities[3].second;
852 
853     if (++entity == entityRecords.end())
854     {
855         get_sdr::response::set_next_record_id(END_OF_RECORD,
856                                               resp); // last record
857     }
858     else
859     {
860         get_sdr::response::set_next_record_id(
861             (ENTITY_RECORD_ID_START + entity->first), resp);
862     }
863 
864     // Check for invalid offset size
865     if (req->offset > sizeof(record))
866     {
867         return IPMI_CC_PARM_OUT_OF_RANGE;
868     }
869 
870     dataLength = std::min(static_cast<size_t>(req->bytes_to_read),
871                           sizeof(record) - req->offset);
872 
873     std::memcpy(resp->record_data,
874                 reinterpret_cast<uint8_t*>(&record) + req->offset, dataLength);
875 
876     *data_len = dataLength;
877     *data_len += 2; // additional 2 bytes for next record ID
878 
879     return IPMI_CC_OK;
880 }
881 
882 ipmi_ret_t ipmi_sen_get_sdr(ipmi_netfn_t netfn, ipmi_cmd_t cmd,
883                             ipmi_request_t request, ipmi_response_t response,
884                             ipmi_data_len_t data_len, ipmi_context_t context)
885 {
886     ipmi_ret_t ret = IPMI_CC_OK;
887     get_sdr::GetSdrReq* req = (get_sdr::GetSdrReq*)request;
888     get_sdr::GetSdrResp* resp = (get_sdr::GetSdrResp*)response;
889     get_sdr::SensorDataFullRecord record = {0};
890 
891     // Note: we use an iterator so we can provide the next ID at the end of
892     // the call.
893     auto sensor = ipmi::sensor::sensors.begin();
894     auto recordID = get_sdr::request::get_record_id(req);
895 
896     // At the beginning of a scan, the host side will send us id=0.
897     if (recordID != 0)
898     {
899         // recordID 0 to 255 means it is a FULL record.
900         // recordID 256 to 511 means it is a FRU record.
901         // recordID greater then 511 means it is a Entity Association
902         // record. Currently we are supporting three record types: FULL
903         // record, FRU record and Enttiy Association record.
904         if (recordID >= ENTITY_RECORD_ID_START)
905         {
906             return ipmi_entity_get_sdr(request, response, data_len);
907         }
908         else if (recordID >= FRU_RECORD_ID_START &&
909                  recordID < ENTITY_RECORD_ID_START)
910         {
911             return ipmi_fru_get_sdr(request, response, data_len);
912         }
913         else
914         {
915             sensor = ipmi::sensor::sensors.find(recordID);
916             if (sensor == ipmi::sensor::sensors.end())
917             {
918                 return IPMI_CC_SENSOR_INVALID;
919             }
920         }
921     }
922 
923     uint8_t sensor_id = sensor->first;
924 
925     /* Header */
926     get_sdr::header::set_record_id(sensor_id, &(record.header));
927     record.header.sdr_version = 0x51; // Based on IPMI Spec v2.0 rev 1.1
928     record.header.record_type = get_sdr::SENSOR_DATA_FULL_RECORD;
929     record.header.record_length = sizeof(get_sdr::SensorDataFullRecord);
930 
931     /* Key */
932     get_sdr::key::set_owner_id_bmc(&(record.key));
933     record.key.sensor_number = sensor_id;
934 
935     /* Body */
936     record.body.entity_id = sensor->second.entityType;
937     record.body.sensor_type = sensor->second.sensorType;
938     record.body.event_reading_type = sensor->second.sensorReadingType;
939     record.body.entity_instance = sensor->second.instance;
940     if (ipmi::sensor::Mutability::Write ==
941         (sensor->second.mutability & ipmi::sensor::Mutability::Write))
942     {
943         get_sdr::body::init_settable_state(true, &(record.body));
944     }
945 
946     // Set the type-specific details given the DBus interface
947     ret =
948         populate_record_from_dbus(&(record.body), &(sensor->second), data_len);
949 
950     if (++sensor == ipmi::sensor::sensors.end())
951     {
952         // we have reached till end of sensor, so assign the next record id
953         // to 256(Max Sensor ID = 255) + FRU ID(may start with 0).
954         auto next_record_id = (frus.size())
955                                   ? frus.begin()->first + FRU_RECORD_ID_START
956                                   : END_OF_RECORD;
957 
958         get_sdr::response::set_next_record_id(next_record_id, resp);
959     }
960     else
961     {
962         get_sdr::response::set_next_record_id(sensor->first, resp);
963     }
964 
965     if (req->offset > sizeof(record))
966     {
967         return IPMI_CC_PARM_OUT_OF_RANGE;
968     }
969 
970     // data_len will ultimately be the size of the record, plus
971     // the size of the next record ID:
972     *data_len = std::min(static_cast<size_t>(req->bytes_to_read),
973                          sizeof(record) - req->offset);
974 
975     std::memcpy(resp->record_data,
976                 reinterpret_cast<uint8_t*>(&record) + req->offset, *data_len);
977 
978     // data_len should include the LSB and MSB:
979     *data_len +=
980         sizeof(resp->next_record_id_lsb) + sizeof(resp->next_record_id_msb);
981 
982     return ret;
983 }
984 
985 static bool isFromSystemChannel()
986 {
987     // TODO we could not figure out where the request is from based on IPMI
988     // command handler parameters. because of it, we can not differentiate
989     // request from SMS/SMM or IPMB channel
990     return true;
991 }
992 
993 ipmi_ret_t ipmicmdPlatformEvent(ipmi_netfn_t netfn, ipmi_cmd_t cmd,
994                                 ipmi_request_t request,
995                                 ipmi_response_t response,
996                                 ipmi_data_len_t dataLen, ipmi_context_t context)
997 {
998     uint16_t generatorID;
999     size_t count;
1000     bool assert = true;
1001     std::string sensorPath;
1002     size_t paraLen = *dataLen;
1003     PlatformEventRequest* req;
1004     *dataLen = 0;
1005 
1006     if ((paraLen < selSystemEventSizeWith1Bytes) ||
1007         (paraLen > selSystemEventSizeWith3Bytes))
1008     {
1009         return IPMI_CC_REQ_DATA_LEN_INVALID;
1010     }
1011 
1012     if (isFromSystemChannel())
1013     { // first byte for SYSTEM Interface is Generator ID
1014         // +1 to get common struct
1015         req = reinterpret_cast<PlatformEventRequest*>((uint8_t*)request + 1);
1016         // Capture the generator ID
1017         generatorID = *reinterpret_cast<uint8_t*>(request);
1018         // Platform Event usually comes from other firmware, like BIOS.
1019         // Unlike BMC sensor, it does not have BMC DBUS sensor path.
1020         sensorPath = "System";
1021     }
1022     else
1023     {
1024         req = reinterpret_cast<PlatformEventRequest*>(request);
1025         // TODO GenratorID for IPMB is combination of RqSA and RqLUN
1026         generatorID = 0xff;
1027         sensorPath = "IPMB";
1028     }
1029     // Content of event data field depends on sensor class.
1030     // When data0 bit[5:4] is non-zero, valid data counts is 3.
1031     // When data0 bit[7:6] is non-zero, valid data counts is 2.
1032     if (((req->data[0] & byte3EnableMask) != 0 &&
1033          paraLen < selSystemEventSizeWith3Bytes) ||
1034         ((req->data[0] & byte2EnableMask) != 0 &&
1035          paraLen < selSystemEventSizeWith2Bytes))
1036     {
1037         return IPMI_CC_REQ_DATA_LEN_INVALID;
1038     }
1039 
1040     // Count bytes of Event Data
1041     if ((req->data[0] & byte3EnableMask) != 0)
1042     {
1043         count = 3;
1044     }
1045     else if ((req->data[0] & byte2EnableMask) != 0)
1046     {
1047         count = 2;
1048     }
1049     else
1050     {
1051         count = 1;
1052     }
1053     assert = req->eventDirectionType & directionMask ? false : true;
1054     std::vector<uint8_t> eventData(req->data, req->data + count);
1055 
1056     sdbusplus::bus::bus dbus(bus);
1057     std::string service =
1058         ipmi::getService(dbus, ipmiSELAddInterface, ipmiSELPath);
1059     sdbusplus::message::message writeSEL = dbus.new_method_call(
1060         service.c_str(), ipmiSELPath, ipmiSELAddInterface, "IpmiSelAdd");
1061     writeSEL.append(ipmiSELAddMessage, sensorPath, eventData, assert,
1062                     generatorID);
1063     try
1064     {
1065         dbus.call(writeSEL);
1066     }
1067     catch (sdbusplus::exception_t& e)
1068     {
1069         phosphor::logging::log<phosphor::logging::level::ERR>(e.what());
1070         return IPMI_CC_UNSPECIFIED_ERROR;
1071     }
1072     return IPMI_CC_OK;
1073 }
1074 
1075 void register_netfn_sen_functions()
1076 {
1077     // <Wildcard Command>
1078     ipmi_register_callback(NETFUN_SENSOR, IPMI_CMD_WILDCARD, nullptr,
1079                            ipmi_sen_wildcard, PRIVILEGE_USER);
1080 
1081     // <Platform Event Message>
1082     ipmi_register_callback(NETFUN_SENSOR, IPMI_CMD_PLATFORM_EVENT, nullptr,
1083                            ipmicmdPlatformEvent, PRIVILEGE_OPERATOR);
1084     // <Get Sensor Type>
1085     ipmi_register_callback(NETFUN_SENSOR, IPMI_CMD_GET_SENSOR_TYPE, nullptr,
1086                            ipmi_sen_get_sensor_type, PRIVILEGE_USER);
1087 
1088     // <Set Sensor Reading and Event Status>
1089     ipmi::registerHandler(ipmi::prioOpenBmcBase, ipmi::netFnSensor,
1090                           ipmi::sensor_event::cmdSetSensorReadingAndEvtSts,
1091                           ipmi::Privilege::Operator, ipmiSetSensorReading);
1092     // <Get Sensor Reading>
1093     ipmi_register_callback(NETFUN_SENSOR, IPMI_CMD_GET_SENSOR_READING, nullptr,
1094                            ipmi_sen_get_sensor_reading, PRIVILEGE_USER);
1095 
1096     // <Reserve Device SDR Repository>
1097     ipmi::registerHandler(ipmi::prioOpenBmcBase, ipmi::netFnSensor,
1098                           ipmi::sensor_event::cmdReserveDeviceSdrRepository,
1099                           ipmi::Privilege::User, ipmiSensorReserveSdr);
1100 
1101     // <Get Device SDR Info>
1102     ipmi::registerHandler(ipmi::prioOpenBmcBase, ipmi::netFnSensor,
1103                           ipmi::sensor_event::cmdGetDeviceSdrInfo,
1104                           ipmi::Privilege::User, ipmiSensorGetDeviceSdrInfo);
1105 
1106     // <Get Device SDR>
1107     ipmi_register_callback(NETFUN_SENSOR, IPMI_CMD_GET_DEVICE_SDR, nullptr,
1108                            ipmi_sen_get_sdr, PRIVILEGE_USER);
1109 
1110     // <Get Sensor Thresholds>
1111     ipmi_register_callback(NETFUN_SENSOR, IPMI_CMD_GET_SENSOR_THRESHOLDS,
1112                            nullptr, ipmi_sen_get_sensor_thresholds,
1113                            PRIVILEGE_USER);
1114 
1115     return;
1116 }
1117