sem/5g_drone_ROS2
1
0
Fork 0
Code Issues 1 Pull Requests 1 Actions Packages Projects Releases Wiki Activity

try diff values

Browse Source
This commit is contained in:
Sem van der Hoeven
2023-04-28 20:40:28 +02:00
parent b775f8015c
commit a037b7f00e
1 changed files with 8 additions and 8 deletions
Download Patch File Download Diff File Expand all files Collapse all files

16
src/px4_connection/src/px4_controller.cpp
View File

@@ -61,10 +61,10 @@ private:
setpoint_count++;
if (setpoint_count % 20 == 0 && thrust <= 1) {
thrust += 0.1;
RCLCPP_INFO(this->get_logger(), "increasing thrust");
}
// if (setpoint_count % 20 == 0 && thrust <= 1) {
// thrust += 0.1;
// RCLCPP_INFO(this->get_logger(), "increasing thrust");
// }
if (setpoint_count == 20)
{
@@ -87,11 +87,11 @@ private:
if (this->get_clock()->now().seconds() - start_time_ < 30)
{
// move up?
msg.thrust_body[0] = thrust; // north
msg.thrust_body[1] = thrust; // east
msg.thrust_body[2] = thrust; // down, 100% thrust up
msg.thrust_body[0] = 0; // north
msg.thrust_body[1] = 0; // east
msg.thrust_body[2] = 1; // down, 100% thrust up
calculate_quaternion(q, 0.1, degrees_to_radians(20), 0.1);
calculate_quaternion(q, 0, degrees_to_radians(20), 0);
}
else