Magnezijum-Robotics/magrob
2
0
Fork 0
Code Issues Pull Requests 1 Actions Packages Projects Releases Wiki Activity

I2c behavior #17

Merged
Pimpest merged 4 commits from i2c_behavior into main 2025-05-07 09:38:18 +00:00
Conversation 0 Commits 4 Files Changed 7 +89
7 changed files with 89 additions and 0 deletions
Download Patch File Download Diff File Expand all files Collapse all files
Showing only changes of commit abf5717286 - Show all commits

11
mg_bt/i2cmodule/i2cnode.cpp
View File

@ -8,7 +8,6 @@ extern "C" {
#include <sys/ioctl.h> #include <sys/ioctl.h>
#include <i2c/smbus.h> #include <i2c/smbus.h>
} }
class MgI2c : public rclcpp::Node { class MgI2c : public rclcpp::Node {
using I2cSrv = mg_msgs::srv::I2c; using I2cSrv = mg_msgs::srv::I2c;
@ -21,7 +20,15 @@ class MgI2c : public rclcpp::Node {
void send_req(I2cSrv::Request::ConstSharedPtr req, I2cSrv::Response::SharedPtr resp) const { void send_req(I2cSrv::Request::ConstSharedPtr req, I2cSrv::Response::SharedPtr resp) const {
ioctl(i2c_fd_, I2C_SLAVE, req->addr); // NOLINT ioctl(i2c_fd_, I2C_SLAVE, req->addr); // NOLINT
int ch = i2c_smbus_read_byte_data(i2c_fd_, req->data); i2c_smbus_write_byte(i2c_fd_, req->data);
int ch = 0;
rclcpp::Rate rate(100);
while (ch == 0 || (ch < 256 && ch > 0)) {
ch = i2c_smbus_read_byte(i2c_fd_);
rate.sleep();
}
resp->resp.push_back(ch); resp->resp.push_back(ch);
RCLCPP_INFO(get_logger(), "Recieved %d", resp->resp.front()); RCLCPP_INFO(get_logger(), "Recieved %d", resp->resp.front());
} }