From 824816ddcbf6f7d3b8b50765640bf64cad4fba24 Mon Sep 17 00:00:00 2001
From: Willian Galvani <williangalvani@gmail.com>
Date: Thu, 20 Feb 2020 16:32:09 -0300
Subject: [PATCH] Sub: send messages to GCS when toggling roll/pitch control

---
 ArduSub/joystick.cpp | 6 ++++++
 1 file changed, 6 insertions(+)

diff --git a/ArduSub/joystick.cpp b/ArduSub/joystick.cpp
index 89f6bf2f6f..ae20a983db 100644
--- a/ArduSub/joystick.cpp
+++ b/ArduSub/joystick.cpp
@@ -561,6 +561,12 @@ void Sub::handle_jsbutton_press(uint8_t _button, bool shift, bool held)
     case JSButton::button_function_t::k_roll_pitch_toggle:
         if (!held) {
             roll_pitch_flag = !roll_pitch_flag;
+            if (roll_pitch_flag) {
+                gcs().send_text(MAV_SEVERITY_INFO, "#Attitude Control");
+            }
+            else {
+                gcs().send_text(MAV_SEVERITY_INFO, "#Movement Control");
+            }
         }
         break;