使用QT搭建ROS程序界面（C++）

1. 搭建QT開發環境，參照創客智造教程https://www.ncnynl.com/archives/201903/2863.html。

需要建立ROS工作空間，這樣可以使用CMAKE進行編譯並自動生成CMakeLists.txt文件。

$mkdir -p ~/catkin_ws/src  $cd ~/catkin_ws/src  $catkin_init_workspace  $cd ~/catkin_ws  $catkin_make

$cd /src  $catkin_create_qt_pkg robomap

2.目標是為機器人開發一個SLAM建圖界面和自主導航顯示界面。參考創客智造教程中的“ROS與QT語言入門教程-顯示ROS發布的地圖消息”那一篇，還需要自己定義一個速度調節滑動條。

　　2.1 在mapp.ui界面加入Slider，類名改為ForBackSlider；修改下述代碼。最后在qnode.cpp中調用Slider的值，使得節點發布的geometry_msgs::Twist消息的值等於ForBackSlider。

mapp.cpp:
slider->setMinimum(0);
slider->setMaximum(100);
ui->ForBackSlider->setMinimum(0);
QObject::connect(ui->ForBackSlider,SIGNAL(valueChanged(int)),this,SLOT(set_speed_value(int));
void MAPP::set_speed_value(int slider_value)
{
   ForBackSpeed=slider_value;          
}

mapp.h:
 private slots:
     void set_speed_value(int s);
 private:
     float ForBackSpeed=0.0;

CMakeLists.txt:(為了支持C++11特性)
set(CMAKE_CXX_FLAGS "${CMAKE_CXX_FLAGS}  -std=c++11)

　　2.2 按鈕啟動ROS的節點，例如：$roscore 、$roslaunch usb_cam usb_cam_node 等，即不用新開終端並輸入一大串命令。

main_window.ui:
插入button，改名為roscore。

main_window.h:
private slots:
    void on_roscore_clicked();

main_window.cpp:
void  robomap::MainWindow::on_roscore_clicked()
{
    system("gnome-terminal -x bash -c 'roscore' &");
}
如果想一個按鈕啟動多個命令，得分別寫對應個數的system()，因為是新開終端。

　　2.3 訂閱攝像頭。

　　　　方式一（取巧，使用按鈕調用命令）：

$roslaunch usb_cam usb_cam_test.launch
參見https://github.com/ros-visualization/rqt_image_view
main_window.cpp:
void robomap::Maindow::on_camera_clicked()
{
　　system("gnome -terminal -x bash -c 'source ~/catkin_ws/devel/setup.bash; rosrun usb_cam usb_cam_node'&");
　　system("gnome -terminal -x bash -c 'rqt_image_view'&");
}

　　　　方式二（不使用按鈕）：參考linux公社的Qt5下實現攝像頭預覽及捕獲圖像方法實例，https://www.linuxidc.com/Linux/2016-03/128792.html

 直接參照原文改得話編譯並不能通過，報錯：QCamera:No such file or directory。確定問題是找不到外部庫和頭文件的問題。
在CMakeLists.txt:
include_directories(/usr/include/x86_64_linux-gnu/qt5/QtMultimedia)
添加后錯誤排除，但在link時有錯誤：undefined reference to 'QCamera:: '
再添加：target_link_libraries(... Qt5::Multimedia），只剩下QCameraViewfinder沒找到外部庫。
再跑去學習CMakeLists.txt的資料，還是無法解決，倒是找到另一種方式specify the c++ standard: set(CMAKE_CXX_STANDARD 11)。

轉而先實現QT界面中調用攝像頭，先實現功能，不在ROS空間中完成：
step1:新建Qt widgets application 工程
step2:https://www.cnblogs.com/annt/p/ant_000.html
step3:運行時報錯，安裝必要的庫。完成功能
cam.pro:
QT       += core gui multimedia multimediawidgets

greaterThan(QT_MAJOR_VERSION, 4): QT += widgets
TARGET = cam
TEMPLATE = app
SOURCES += main.cpp\
        mainwindow.cpp
HEADERS  += mainwindow.h
FORMS    += mainwindow.ui
mainwindow.h:
#ifndef MAINWINDOW_H
#define MAINWINDOW_H

#include <QMainWindow>
#include <QCamera>
#include <QCameraViewfinder>
#include <QCameraImageCapture>
#include <QFileDialog>



namespace Ui {
class MainWindow;
}

class QCamera;
class QCameraViewfinder;
class QCameraImageCapture;

class MainWindow : public QMainWindow
{
Q_OBJECT

public:
explicit MainWindow(QWidget *parent = 0);
~MainWindow();

private slots:
void captureImage();
void displayImage(int,QImage);
void saveImage();

private:
Ui::MainWindow *ui;

QCamera *camera;
QCameraViewfinder *viewfinder;
QCameraImageCapture *imageCapture;
};

#endif // MAINWINDOW_H
mainwindow.cpp:
#include "mainwindow.h"
#include "ui_mainwindow.h"

MainWindow::MainWindow(QWidget *parent) :
QMainWindow(parent),
ui(new Ui::MainWindow)
{
ui->setupUi(this);

camera=new QCamera(this);
viewfinder=new QCameraViewfinder(this);
imageCapture=new QCameraImageCapture(camera);

ui->ImageView->addWidget(viewfinder);
ui->ImageCapture->setScaledContents(true);

camera->setViewfinder(viewfinder);
camera->start();

connect(imageCapture, SIGNAL(imageCaptured(int,QImage)), this, SLOT(displayImage(int,QImage)));

connect(ui->buttonCapture, SIGNAL(clicked()), this, SLOT(captureImage()));
connect(ui->buttonSave, SIGNAL(clicked()), this, SLOT(saveImage()));
connect(ui->buttonQuit, SIGNAL(clicked()), qApp, SLOT(quit()));
}

MainWindow::~MainWindow()
{
delete ui;
}

void MainWindow::captureImage()
{
ui->statusBar->showMessage(tr("capturing..."), 1000);
imageCapture->capture();
}

void MainWindow::displayImage(int , QImage image)
{
ui->ImageCapture->setPixmap(QPixmap::fromImage(image));

ui->statusBar->showMessage(tr("capture OK!"), 5000);
}

void MainWindow::saveImage()
{
QString fileName=QFileDialog::getSaveFileName(this, tr("save file"), QDir::homePath(), tr("jpegfile(*.jpg)"));
if(fileName.isEmpty()) {
ui->statusBar->showMessage(tr("save cancel"), 5000);
return;
}
const QPixmap* pixmap=ui->ImageCapture->pixmap();
if(pixmap) {
pixmap->save(fileName);
ui->statusBar->showMessage(tr("save OK"), 5000);
}
}
功能可以實現。調用攝像頭，截圖，保存等。


接着在ROS空間中進行代碼修改。（搜到一篇博客，是用CMAKE編譯工程的，需要在CMakeLists文件添加qt庫）（Ubuntu下Qt Multimedia 播放mp3文件注意事項）
CMakeLists.txt:
find_package(Qt5 REQUIRED Core Widgets SerialPort Multimedia)
set(QT_LIBRARIES Qt5::Widgets Qt5::SerialPort Qt5::Multimedia)
參照博客中的寫法，加入MultimediaWidgets模塊，編譯成功


3.開啟turtlebot仿真，驗證程序。
sudo apt-get install ros-kinetic-turtlebot ros-kinetic-turtlebot-apps ro-kinetic-turtlebot-interactions ros-kinetic-turtlebot-sumulatio ros-kinetic-kobuki-ftdi
source /opt/ros/kinetic/setup.bash
roslaunch turtlebot_gazebo turtlebot_world.launch 需要等幾分鍾加載
roslaunch turtlebot_gazebo gmapping_demo.launch
roslaunch turtlebot_teleop keyboard_teleop.launch