mirror of
https://github.com/modelec/modelec-marcel-ROS.git
synced 2026-01-18 16:47:43 +01:00
Refactor solar panel angle message publishing logic in game controller listener
This commit is contained in:
@@ -151,21 +151,21 @@ namespace Modelec {
|
||||
|
||||
if (msg->axes[2] != last_solar_1_angle) {
|
||||
int solarPannelAngle = static_cast<int>(Modelec::mapValue(static_cast<float>(msg->axes[2]), -1.0f, 1.0f, solarPannelServos[0].startAngle, solarPannelServos[0].endAngle));
|
||||
/*auto solarPannelAngleMessage = modelec_interface::msg::PCA9685Servo();
|
||||
auto solarPannelAngleMessage = modelec_interface::msg::PCA9685Servo();
|
||||
solarPannelAngleMessage.pin = solarPannelServos[0].pin;
|
||||
solarPannelAngleMessage.angle = solarPannelAngle;
|
||||
pca9685_publisher_->publish(solarPannelAngleMessage);*/
|
||||
pca9685_publisher_->publish(solarPannelAngleMessage);
|
||||
last_solar_1_angle = msg->axes[2];
|
||||
}
|
||||
|
||||
/*if (msg->axes[5] != last_solar_2_angle) {
|
||||
if (msg->axes[5] != last_solar_2_angle) {
|
||||
int solarPannelAngle = static_cast<int>(Modelec::mapValue(static_cast<float>(msg->axes[5]), -1.0f, 1.0f, solarPannelServos[1].endAngle, solarPannelServos[1].startAngle));
|
||||
auto solarPannelAngleMessage = modelec_interface::msg::PCA9685Servo();
|
||||
solarPannelAngleMessage.pin = solarPannelServos[1].pin;
|
||||
solarPannelAngleMessage.angle = solarPannelAngle;
|
||||
pca9685_publisher_->publish(solarPannelAngleMessage);
|
||||
last_solar_2_angle = msg->axes[5];
|
||||
}*/
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
Reference in New Issue
Block a user