Navigation eines FTF mit ROS2

Autor: Yannick Schmidt
Art: Projektarbeit
Dauer: April - September 2022
Betreuer: Prof. Schneider

Thema

Das Thema der Projektarbeit ist es das Fahrerlose Transportfahrzeug mit ROS2 zu navigieren

Aufgabenstellung

Einarbeitung in ROS 2 und die FTF Hardware
Optimierung der Navigation in der WeBots Simulation
Inbetriebnahme der FTF Sensoren
Sicherer Betriebszustand und Notaus
Ansteuerung der FTF Aktoren
Schnittstelle ROS2 zum FTF herstellen
Navigation des FTF in einer realen Umgebung
Ausblick auf Optimierungspotential
Dokumentation der Erkenntnisse in einem Wiki Artikel

Anforderungen an die Projektarbeit

Wissenschaftliche Vorgehensweise (Projektplan, etc.), nützlicher Artikel: Gantt Diagramm erstellen
Zweiwöchentlicher Fortschrittsberichte (informativ)
Projektvorstellung im Wiki
Regeln zum Umgang mit SVN
Studentische Arbeiten bei Prof. Schneider
Anforderungen an eine wissenschaftlich Arbeit

Projektplan

Notwendige ROS2 Bibliotheken

Kartografierung

cartographer_node
occupancy_grid_node
RP_Lidar
map_server

Lokalisierung

nav2_amcl

Pfad Planung

nav2_planner
nav2_controller
nav2_bt_navigator
nav2_recoveries

Aktorsteuerung

ros2_canopen

Objektumgehung

nav2_coastmap

Inberiebnahme der Simulation

Die Simulationsdateien sind im Projektordner unter "trunk\Projekte\FTF_Hanning\FTS\" gespeichert.
Zum Ausführen der Simulation müssen diverse Pakete installiert sein. Um diese Pakete nun einfach zu installieren lässt sich folgender Kommandozeilenbefehl ausführen:
sudo apt install ros-${ROS_DISTRO}-navigation2 ros-${ROS_DISTRO}-nav2-bringup '~ros-${ROS_DISTRO}-turtlebot3-.*' ros-${ROS_DISTRO}-laser-geometry ros-${ROS_DISTRO}-webots-ros2

Zudem muss die Simulationsumgebung Webots installiert werden:
wget -qO- https://cyberbotics.com/Cyberbotics.asc | sudo apt-key add -
sudo apt-add-repository 'deb https://cyberbotics.com/debian/ binary-amd64/'
sudo apt-get update
sudo apt-get install webots

Inbetriebnahme der FTF Sensoren

Lidar

Das RPLidar ist mit dem rplidar_ros2 Paket ansteuerbar.

 rplidar_node = Node(
        name='rplidar_composition',
        package='rplidar_ros',
        executable='rplidar_composition',
        output='screen',
        parameters=[{
            'serial_port': '/dev/RPLidar',
            'serial_baudrate': 115200,  # A2
            'frame_id': 'base_scan',
            'inverted': False,
            'angle_compensate': True,
        }],
    )

9-Achsen Gyroskop

Die Bosch IMU BNO055 ist mit dem bno055 Paket ansteuerbar.

imu_node = Node(
        name='bno055',
        package='bno055',
        executable='bno055',
        parameters=[{
            'uart_port': '/dev/FTDI_1',
            'uart_baudrate': 115200,
            'frame_id': 'imu_link',
        }],
    )

Ansteuerung der FTF Aktoren

CANopenLinux

Zur Ansteuerung der Motoren wird eine CANopen Node mit der ID=3 eröffnet.
Um den PCAN Treiber zu laden muss folgender Befehl ausgeführt werden:
sudo modprobe pcan
Dazu muss zunächst die CAN Schnittstelle zugewiesen werden:
sudo ip link set up can0 type can bitrate 250000

Anschließend wird die Node erstellt:
canopend can0 -i 3 -c "local-/tmp/CO_command_socket"

Der CANBus kann mit candump can0 ausgelesen werden.

Mit cocomm "<node> <r/w> <index> <subindex> <datatype> <value>" können Befehle gesendet/ausgelesen werden.

Peak CANController Setup für ros2_canopen:
sudo modprobe peak_usb
sudo ip link set can0 up type can bitrate 250000
sudo ip link set can0 txqueuelen 250
sudo ip link set up can0

Nützliche Befehle

Motorsetup

0x6040 ControlWord
Das ControlWord dient zur Bewegungssteuerung

Data Type: UNSIGNED16
Access Type: write only

ControlWord Bits
15	11	10	9	8	7	6	4	3	2	1	0
Manufacturer Specific		Reserved		Halt	Fault Reset	Operation Mode Specific		Enable Operation	Quick Stop	Enable Voltage	Switch on

0x6060 Modes_of_operation
Schalter zur Auswahl des Operationsmodus.

Data Type: INTEGER8
Access Type: write only

Mode of Operation	Action
-2	SYNC Q Mode
-1	Normal Q Mode
1	Profile Position Mode
3	Profile Velocity Mode
4	Torque Profile Mode
6	Homing Mode

Der Operationsmodus steht in 0x6061.

0x6083/0x6084 profile_acceleration/deceleration
Profil Beschleunigungs/Verzögerungsgeschwindigkeit in 100 rps/s.

Data Type: UNSIGNED32
Access Type: read/write

0x6081 P2P_profile_velocity
Maximale Geschwindigkeit.

Data Type: UNSIGNED32
Access Type: read/write

Bewegungssteuerung

0x607A target_position
Zielposition für den Profile Position Mode.

Data Type: INTEGER32
Access Type: read/write

ControlWord Bit 6 setzen:

0 für absolute Position
1 für relative Position

0x60FF profile_velocity
Zielgeschwindigkeit in Umdrehungen/Sekunde.
Wert muss mit 240 multipliziert werden.

Data Type: INTEGER32
Access Type: read/write

Motorwerte

0x6064 Position_value_calculated
Zeigt die errechnete Encoderposition.

Data Type: INTEGER32
Access Type: read only

0x6064 position_actual_value
Zeigt die echte Encoderposition.

Data Type: INTEGER32
Access Type: read only

0x606C Velocity_value_calaculated
Zeigt die errechnete Geschwindigkeit in Umdrehungen/Sekunde.
Wert muss mit 240 dividiert werden.

Data Type: INTEGER32
Access Type: read only

0x7009 velocity_actual_value
Zeigt die echte Geschwindigkeit in Umdrehungen/Sekunde.
Wert muss mit 240 dividiert werden.

Data Type: UNSIGNED16
Access Type: read only

Inbetriebnahme

Abhängigkeiten überprüfen
sudo rosdep init
rosdep update
rosdep install --from-paths src -y --ignore-src

Pakete bauen

Hinweis: erst canopen_interfaces mit colcon build --merge-install --packages-select canopen_interfaces bauen

Dann mit colcon build --merge-install alles bauen.

Pakete sourcen
source install/local_setup.bash

1. Interface auf dem Raspberry Pi starten

Als erstes wird das ros2_canopen Interface gestartet:
ros2 launch ftf_motor_controller bring_up.launch.py
Dann die Differentialantrieb Controller und die Sensoren:
ros2 launch hewagv_bringup hewagv_drives_only_launch.py

2. Navigation starten

Auf dem Hauptrechner wird dann die Navigation gestartet.
Für die Kartografierung mit SLAM-Algorithmus:
ros2 launch hewagv_bringup hewagv_loc_launch.py
Für die Navigation auf einer bestehenden Karte:
ros2 launch hewagv_bringup hewagv_nav_launch.py

Ergebnis

Zusammenfassung

Lessons Learned

Projektunterlagen

Link zu den SVN-Ordnern des Projekt:
https://svn.hshl.de/svn/Robotik_und_Autonome-Systeme/trunk/Mitgliederordner/2022_Yannick_Schmidt/
https://svn.hshl.de/svn/Robotik_und_Autonome-Systeme/branches/2022_10_Schmidt_FTF_ws/

YouTube Video

Das Video von diesem Projekt finden Sie auf Youtube unter dem Link:

Weblinks

Literatur

→ zurück zum Hauptartikel: Studentische Arbeiten