i2c.h

Go to the documentation of this file.

// Copyright (c) Space-ng, inc. All rights reserved.
 
#pragma once
#include <sol3/base_unit/msg/i2c.h>
 
namespace sol3 {
namespace base_unit {
 
inline uint8_t getI2CBusId(msg::I2CDevice device) {
  return uint8_t(device >> uint16_t(8));
}
 
inline uint8_t getI2CDeviceAddress(msg::I2CDevice device) {
  return uint8_t(device & uint16_t(0x00FF));
}
 
inline msg::I2CDevice makeI2CDevice(uint8_t bus, uint8_t address) {
  uint16_t bus_addr = uint16_t(uint16_t(bus) << 8) | uint16_t(address);
  return static_cast<msg::I2CDevice>(bus_addr);
}
 
inline char const* getI2CDeviceName(msg::I2CDevice device) {
  char const* name = msg::EnumNameI2CDevice(device);
  if (std::string("") == name) {
    // fallback to 0 bus
    name =
        msg::EnumNameI2CDevice(makeI2CDevice(0, getI2CDeviceAddress(device)));
  }
  return name;
}
 
}  // namespace base_unit
}  // namespace sol3