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

merge Service branch into main #5

Merged
SemvdH merged 193 commits from service into main 2023-05-08 13:42:59 +00:00
Conversation 0 Commits 193 Files Changed 27 +9 -9
1 changed files with 9 additions and 9 deletions
Download Patch File Download Diff File Expand all files Collapse all files
Showing only changes of commit db1322e2de - Show all commits

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

@@ -83,16 +83,16 @@ private:
{
if (armed)
{
last_setpoint[1] = degrees_to_radians(request->yaw);
last_setpoint[0] = degrees_to_radians(request->pitch);
if (request->yaw == 0 && request->pitch = 0 && request->roll = 0)
{
last_setpoint[0] = degrees_to_radians(request->yaw);
last_setpoint[1] = degrees_to_radians(request->pitch);
last_setpoint[2] = degrees_to_radians(request->roll);
// if (request->yaw == 0 && request->pitch = 0 && request->roll = 0)
// {
// } else {
// last_setpoint[0] += degrees_to_radians(request->yaw);
// last_setpoint[1] += degrees_to_radians(request->pitch);
// last_setpoint[2] += degrees_to_radians(request->roll);
// }
} else {
last_setpoint[0] += degrees_to_radians(request->yaw);
last_setpoint[1] += degrees_to_radians(request->pitch);
last_setpoint[2] += degrees_to_radians(request->roll);
}
last_thrust = request->thrust;