Add sensors to a link via the GUI

include/ignition/gazebo/rendering/RenderUtil.hh

@@ -83,7 +83,7 @@ inline namespace IGNITION_GAZEBO_VERSION_NAMESPACE {
     /// \param[in] _ecm Const reference to the entity component manager
     /// \param[in] _entities Entities to create visuals for.
     public: void CreateVisualsForEntities(const EntityComponentManager &_ecm,
-                const std::set<Entity> &_entities);
+                                          const std::set<Entity> &_entities);
 
     /// \brief Set the rendering engine to use
     /// \param[in] _engineName Name of the rendering engine.

src/gui/plugins/component_inspector/AirPressure.cc

@@ -68,7 +68,7 @@ Q_INVOKABLE void AirPressure::OnAirPressureNoise(
       [=](EntityComponentManager &_ecm)
   {
     auto comp = _ecm.Component<components::AirPressureSensor>(
-        this->inspector->Entity());
+        this->inspector->GetEntity());
     if (comp)
     {
       sdf::AirPressure *airpressure = comp->Data().AirPressureSensor();
@@ -100,7 +100,7 @@ Q_INVOKABLE void AirPressure::OnAirPressureReferenceAltitude(
       [=](EntityComponentManager &_ecm)
   {
     auto comp = _ecm.Component<components::AirPressureSensor>(
-        this->inspector->Entity());
+        this->inspector->GetEntity());
     if (comp)
     {
       sdf::AirPressure *airpressure = comp->Data().AirPressureSensor();

src/gui/plugins/component_inspector/Altimeter.cc

@@ -72,7 +72,7 @@ Q_INVOKABLE void Altimeter::OnAltimeterPositionNoise(
       [=](EntityComponentManager &_ecm)
   {
     auto comp = _ecm.Component<components::Altimeter>(
-        this->inspector->Entity());
+        this->inspector->GetEntity());
     if (comp)
     {
       sdf::Altimeter *altimeter = comp->Data().AltimeterSensor();
@@ -106,7 +106,7 @@ Q_INVOKABLE void Altimeter::OnAltimeterVelocityNoise(
       [=](EntityComponentManager &_ecm)
   {
     auto comp = _ecm.Component<components::Altimeter>(
-        this->inspector->Entity());
+        this->inspector->GetEntity());
     if (comp)
     {
       sdf::Altimeter *altimeter = comp->Data().AltimeterSensor();

src/gui/plugins/component_inspector/ComponentInspector.cc

@@ -1054,7 +1054,7 @@ Entity ComponentInspector::GetEntity() const
 }
 
 /////////////////////////////////////////////////
-void ComponentInspector::SetEntity(const Entity &_entity)
+void ComponentInspector::SetEntity(const gazebo::Entity &_entity)
 {
   // If nothing is selected, display world properties
   if (_entity == kNullEntity)

src/gui/plugins/component_inspector/ComponentInspector.hh

@@ -346,7 +346,7 @@ namespace gazebo
 
     /// \brief Set the entity currently inspected.
     /// \param[in] _entity Entity ID.
-    public: Q_INVOKABLE void SetEntity(const Entity &_entity);
+    public: Q_INVOKABLE void SetEntity(const gazebo::Entity &_entity);
 
     /// \brief Notify that entity has changed.
     signals: void EntityChanged();

src/gui/plugins/component_inspector/ComponentInspector.qml

@@ -306,34 +306,34 @@ Rectangle {
       }
 
       ToolButton {
-        id: addButton
+        id: addLinkButton
         checkable: false
         text: "Add entity"
         visible: entityType == "model"
         contentItem: Image {
           fillMode: Image.Pad
           horizontalAlignment: Image.AlignHCenter
           verticalAlignment: Image.AlignVCenter
-          source: "qrc:/Gazebo/images/plus.png"
+          source: "qrc:/Gazebo/images/plus-link.png"
           sourceSize.width: 18;
           sourceSize.height: 18;
         }
-        ToolTip.text: "Add an entity to a model"
+        ToolTip.text: "Add a link or light to a model"
         ToolTip.visible: hovered
         ToolTip.delay: Qt.styleHints.mousePressAndHoldInterval
         onClicked: {
-          getSimPaused() ? addLinkMenu.open() : pausePopup.open()
+          getSimPaused() ? addLinkMenu.open() : linkAddPausePopup.open()
         }
         Popup {
-          id: pausePopup
+          id: linkAddPausePopup
           modal: true
           focus: true
-          x: parent.width - popupContentText.width
-          y: parent.height + popupContentText.height
+          x: parent.width - linkAdPopupContentText.width
+          y: parent.height + linkAdPopupContentText.height
           contentItem: Text {
-            id: popupContentText
+            id: linkAdPopupContentText
             padding: 10
-            text: "Pause simulation to add an entity"
+            text: "Pause simulation to add a link or light"
           }
           closePolicy: Popup.CloseOnEscape | Popup.CloseOnPressOutsideParent
         }
@@ -350,7 +350,6 @@ Rectangle {
           }
         }
 
-
         Menu {
           id: addLinkMenu
 
@@ -577,7 +576,175 @@ Rectangle {
               addLinkMenu.close()
             }
           }
+        }
+      }
 
+      ToolButton {
+        id: addSensorButton
+        checkable: false
+        text: "Add sensor"
+        visible: entityType == "link"
+        contentItem: Image {
+          fillMode: Image.Pad
+          horizontalAlignment: Image.AlignHCenter
+          verticalAlignment: Image.AlignVCenter
+          source: "qrc:/Gazebo/images/plus-sensor.png"
+          sourceSize.width: 18;
+          sourceSize.height: 18;
+        }
+        ToolTip.text: "Add a sensor to a link"
+        ToolTip.visible: hovered
+        ToolTip.delay: Qt.styleHints.mousePressAndHoldInterval
+        onClicked: {
+          getSimPaused() ? addSensorMenu.open() : sensorAddPausePopup.open()
+        }
+        Popup {
+          id: sensorAddPausePopup
+          modal: true
+          focus: true
+          x: parent.width - sensorAddPopupContentText.width
+          y: parent.height + sensorAddPopupContentText.height
+          contentItem: Text {
+            id: sensorAddPopupContentText
+            padding: 10
+            text: "Pause simulation to add a sensor"
+          }
+          closePolicy: Popup.CloseOnEscape | Popup.CloseOnPressOutsideParent
+        }
+
+        Menu {
+          id: addSensorMenu
+          MenuItem {
+            id: airPressure
+            text: "Air pressure"
+            onTriggered: {
+              ComponentInspector.OnAddEntity(airPressure.text, "sensor");
+            }
+          }
+
+          MenuItem {
+            id: altimeter
+            text: "Altimeter"
+            onTriggered: {
+              ComponentInspector.OnAddEntity(altimeter.text, "sensor");
+            }
+          }
+
+          MenuItem {
+            id: cameraSensorMenu
+            text: "Camera >"
+
+            MouseArea {
+              id: viewSubCameraArea
+              anchors.fill: parent
+              hoverEnabled: true
+              onEntered: cameraSubmenu.open()
+            }
+          }
+
+          MenuItem {
+            id: contact
+            text: "Contact"
+            onTriggered: {
+              ComponentInspector.OnAddEntity(contact.text, "sensor");
+            }
+          }
+
+          MenuItem {
+            id: forceTorque
+            text: "Force torque"
+            onTriggered: {
+              ComponentInspector.OnAddEntity(forceTorque.text, "sensor");
+            }
+          }
+
+          /*MenuItem {
+            id: gps
+            text: "GPS"
+            onTriggered: {
+              ComponentInspector.OnAddEntity(gps.text, "sensor");
+            }
+          }*/
+
+          MenuItem {
+            id: gpuLidar
+            text: "GPU Lidar"
+             onTriggered: {
+              ComponentInspector.OnAddEntity("gpu_lidar", "sensor");
+            }
+          }
+
+          MenuItem {
+            id: imu
+            text: "IMU"
+            onTriggered: {
+              ComponentInspector.OnAddEntity(imu.text, "sensor");
+            }
+          }
+
+          MenuItem {
+            id: magnetometer
+            text: "Magnetometer"
+            onTriggered: {
+              ComponentInspector.OnAddEntity(magnetometer.text, "sensor");
+            }
+          }
+        }
+
+        Menu {
+          id: cameraSubmenu
+          x: addSensorMenu.x - addSensorMenu.width
+          y: addSensorMenu.y + cameraSensorMenu.y
+
+          MenuItem {
+            id: depth
+            text: "Depth"
+             onTriggered: {
+              ComponentInspector.OnAddEntity("depth_camera", "sensor");
+            }
+          }
+          MenuItem {
+            id: logical
+            text: "Logical"
+             onTriggered: {
+              ComponentInspector.OnAddEntity("logical_camera", "sensor");
+            }
+          }
+          MenuItem {
+            id: monocular
+            text: "Monocular"
+             onTriggered: {
+              ComponentInspector.OnAddEntity("camera", "sensor");
+            }
+          }
+          /*MenuItem {
+            id: multicamera
+            text: "Multicamera"
+             onTriggered: {
+              ComponentInspector.OnAddEntity("multicamera", "sensor");
+            }
+          }*/
+          MenuItem {
+            id: rgbd
+            text: "RGBD"
+             onTriggered: {
+              ComponentInspector.OnAddEntity("rgbd_camera", "sensor");
+            }
+          }
+          MenuItem {
+            id: segmentation
+            text: "Segmentation"
+             onTriggered: {
+              ComponentInspector.OnAddEntity("segmentation_camera", "sensor");
+            }
+          }
+          MenuItem {
+            id: thermal
+            text: "Thermal"
+             onTriggered: {
+              ComponentInspector.OnAddEntity("thermal_camera", "sensor");
+            }
+          }
         }
       }
 
@@ -592,7 +759,6 @@ Rectangle {
     }
   }
 
-
   ListView {
     anchors.top: header.bottom
     anchors.bottom: parent.bottom

src/gui/plugins/component_inspector/ExpandingTypeHeader.qml

@@ -49,7 +49,7 @@ Rectangle {
       fillMode: Image.Pad
       Layout.alignment : Qt.AlignVCenter
       source: content.show ?
-          "qrc:/Gazebo/images/minus.png" : "qrc:/Gazebo/images/plus.png"
+          "qrc:/Gazebo/images/chevron-down.svg" : "qrc:/Gazebo/images/chevron-right.svg"
     }
     TypeHeader {
       id: typeHeader

src/gui/plugins/component_inspector/Imu.cc

@@ -103,7 +103,7 @@ Q_INVOKABLE void Imu::OnLinearAccelerationXNoise(
       [=](EntityComponentManager &_ecm)
   {
     auto comp = _ecm.Component<components::Imu>(
-        this->inspector->Entity());
+        this->inspector->GetEntity());
     if (comp)
     {
       sdf::Imu *imu = comp->Data().ImuSensor();
@@ -137,7 +137,7 @@ Q_INVOKABLE void Imu::OnLinearAccelerationYNoise(
       [=](EntityComponentManager &_ecm)
   {
     auto comp = _ecm.Component<components::Imu>(
-        this->inspector->Entity());
+        this->inspector->GetEntity());
     if (comp)
     {
       sdf::Imu *imu = comp->Data().ImuSensor();
@@ -171,7 +171,7 @@ Q_INVOKABLE void Imu::OnLinearAccelerationZNoise(
       [=](EntityComponentManager &_ecm)
   {
     auto comp = _ecm.Component<components::Imu>(
-        this->inspector->Entity());
+        this->inspector->GetEntity());
     if (comp)
     {
       sdf::Imu *imu = comp->Data().ImuSensor();
@@ -205,7 +205,7 @@ Q_INVOKABLE void Imu::OnAngularVelocityXNoise(
       [=](EntityComponentManager &_ecm)
   {
     auto comp = _ecm.Component<components::Imu>(
-        this->inspector->Entity());
+        this->inspector->GetEntity());
     if (comp)
     {
       sdf::Imu *imu = comp->Data().ImuSensor();
@@ -239,7 +239,7 @@ Q_INVOKABLE void Imu::OnAngularVelocityYNoise(
       [=](EntityComponentManager &_ecm)
   {
     auto comp = _ecm.Component<components::Imu>(
-        this->inspector->Entity());
+        this->inspector->GetEntity());
     if (comp)
     {
       sdf::Imu *imu = comp->Data().ImuSensor();
@@ -273,7 +273,7 @@ Q_INVOKABLE void Imu::OnAngularVelocityZNoise(
       [=](EntityComponentManager &_ecm)
   {
     auto comp = _ecm.Component<components::Imu>(
-        this->inspector->Entity());
+        this->inspector->GetEntity());
     if (comp)
     {
       sdf::Imu *imu = comp->Data().ImuSensor();

src/gui/plugins/component_inspector/JointType.cc

@@ -81,10 +81,10 @@ Q_INVOKABLE void JointType::OnJointType(QString _jointType)
       [=](EntityComponentManager &_ecm)
   {
     components::JointType *comp =
-      _ecm.Component<components::JointType>(this->inspector->Entity());
+      _ecm.Component<components::JointType>(this->inspector->GetEntity());
 
     components::ParentEntity *parentComp =
-      _ecm.Component<components::ParentEntity>(this->inspector->Entity());
+      _ecm.Component<components::ParentEntity>(this->inspector->GetEntity());
 
     if (comp && parentComp)
     {

src/gui/plugins/component_inspector/Lidar.cc

@@ -82,7 +82,7 @@ Q_INVOKABLE void Lidar::OnLidarNoise(
       [=](EntityComponentManager &_ecm)
   {
     auto comp = _ecm.Component<components::GpuLidar>(
-        this->inspector->Entity());
+        this->inspector->GetEntity());
     if (comp)
     {
       sdf::Lidar *lidar = comp->Data().LidarSensor();
@@ -120,7 +120,7 @@ Q_INVOKABLE void Lidar::OnLidarChange(
       [=](EntityComponentManager &_ecm)
   {
     auto comp = _ecm.Component<components::GpuLidar>(
-        this->inspector->Entity());
+        this->inspector->GetEntity());
     if (comp)
     {
       sdf::Lidar *lidar = comp->Data().LidarSensor();