forked from cesar.alejandro/oscillation_ctrl
Changed README and added launch files
This commit is contained in:
parent
859cd81e4e
commit
bee8a6033d
138
README.md
138
README.md
|
|
@ -1,3 +1,141 @@
|
||||||
# oscillation_ctrl
|
# oscillation_ctrl
|
||||||
|
|
||||||
Repo containing oscillation damping controller for tether missions + instructions how to to set up
|
Repo containing oscillation damping controller for tether missions + instructions how to to set up
|
||||||
|
|
||||||
|
Cesar Rodriguez
|
||||||
|
|
||||||
|
cesar.rodriguez@spirirobotics.com
|
||||||
|
|
||||||
|
February 2022
|
||||||
|
|
||||||
|
Steps to recreate stable PX4 environment + working repo
|
||||||
|
|
||||||
|
## 1) Installing ROS Melodic
|
||||||
|
|
||||||
|
### SETUP SOURCES.LIST
|
||||||
|
sudo sh -c 'echo "deb http://packages.ros.org/ros/ubuntu $(lsb_release -sc) main" > /etc/apt/sources.list.d/ros-latest.list'
|
||||||
|
### SETUP YOUR KEYS
|
||||||
|
sudo apt install curl # if you haven't already installed curl
|
||||||
|
curl -s https://raw.githubusercontent.com/ros/rosdistro/master/ros.asc | sudo apt-key add -
|
||||||
|
### INSTALLATION
|
||||||
|
sudo apt update
|
||||||
|
sudo apt install ros-melodic-desktop-full
|
||||||
|
### ENVIRONMENT SETUP
|
||||||
|
echo "source /opt/ros/melodic/setup.bash" >> ~/.bashrc
|
||||||
|
### DEPENDENCIES
|
||||||
|
sudo apt install python-rosdep python-rosinstall python-rosinstall-generator python-wstool build-essential
|
||||||
|
|
||||||
|
Initilize rosdep:
|
||||||
|
|
||||||
|
sudo apt install python-rosdep
|
||||||
|
sudo rosdep init
|
||||||
|
rosdep update
|
||||||
|
### PX4 DEPENDENCIES
|
||||||
|
sudo apt-get install python-catkin-tools python-rosinstall-generator -y
|
||||||
|
wstool init ~/catkin_ws/src
|
||||||
|
### MAVLINK
|
||||||
|
rosinstall_generator --rosdistro melodic mavlink | tee /tmp/mavros.rosinstall
|
||||||
|
### MAVROS
|
||||||
|
rosinstall_generator --upstream mavros | tee -a /tmp/mavros.rosinstall
|
||||||
|
### CREATE WORKSPACE AND DEPS
|
||||||
|
cd ~/catkin_ws
|
||||||
|
wstool merge -t src /tmp/mavros.rosinstall
|
||||||
|
wstool update -t src -j4
|
||||||
|
rosdep install --from-paths src --ignore-src -y
|
||||||
|
### INSTALL GEOGRAPHIC LIB DATASETS
|
||||||
|
cd ~/catkin_ws
|
||||||
|
sudo ./src/mavros/mavros/scripts/install_geographiclib_datasets.sh
|
||||||
|
### BUILD SOURCE
|
||||||
|
cd ~/catkin_ws
|
||||||
|
catkin build
|
||||||
|
|
||||||
|
## 2) PX4 Environment Development
|
||||||
|
|
||||||
|
### DOWNLOAD PX4 SOURCE CODE
|
||||||
|
git clone https://github.com/PX4/PX4-Autopilot.git --recursive
|
||||||
|
|
||||||
|
### RUN UBUNTU.SH
|
||||||
|
bash ./PX4-Autopilot/Tools/setup/ubuntu.sh
|
||||||
|
#Restart computer after it is done
|
||||||
|
|
||||||
|
### BUILD ROS/GAZEBO: Gets Gazebo9
|
||||||
|
wget https://raw.githubusercontent.com/PX4/Devguide/master/build_scripts/ubuntu_sim_ros_melodic.sh
|
||||||
|
bash ubuntu_sim_ros_melodic.sh
|
||||||
|
|
||||||
|
#### Download QGroundControl from:
|
||||||
|
https://docs.qgroundcontrol.com/master/en/releases/daily_builds.html
|
||||||
|
|
||||||
|
#### Build jMAVSim and Gazebo
|
||||||
|
cd ~/PX4-Autopilot
|
||||||
|
make px4_sitl jmavsim
|
||||||
|
#May need to open QGroundControl for it to work
|
||||||
|
make px4_sitl gazebo
|
||||||
|
|
||||||
|
#### Create px4 package
|
||||||
|
cd ~/PX4-Autopilot
|
||||||
|
DONT_RUN=1 make px4_sitl_default gazebo
|
||||||
|
source Tools/setup_gazebo.bash $(pwd) $(pwd)/build/px4_sitl_default
|
||||||
|
export ROS_PACKAGE_PATH=$ROS_PACKAGE_PATH:$(pwd)
|
||||||
|
export ROS_PACKAGE_PATH=$ROS_PACKAGE_PATH:$(pwd)/Tools/sitl_gazebo
|
||||||
|
roslaunch px4 posix_sitl.launch
|
||||||
|
|
||||||
|
## 3) oscillation_ctrl Dependencies
|
||||||
|
### INSTALL XTERM
|
||||||
|
sudo apt-get update -y
|
||||||
|
sudo apt-get install -y xterm
|
||||||
|
|
||||||
|
### INSTALL MAVROS_CONTROLLERS
|
||||||
|
cd ~/catkin_ws/src
|
||||||
|
#clone repo:
|
||||||
|
git clone https://github.com/Jaeyoung-Lim/mavros_controllers
|
||||||
|
#Download dependencies:
|
||||||
|
cd ~/catkin_ws
|
||||||
|
wstool merge -t src src/mavros_controllers/dependencies.rosinstall
|
||||||
|
wstool update -t src -j4
|
||||||
|
rosdep install --from-paths src --ignore-src -y --rosdistro $ROS_DISTRO
|
||||||
|
catkin build
|
||||||
|
source ~/catkin_ws/devel/setup.bash
|
||||||
|
#####Troubleshooting: https://github.com/Jaeyoung-Lim/mavros_controllers
|
||||||
|
### TOOLS/SITL_GAZEBO
|
||||||
|
copy (or add) files in 'oscillation_ctrl/models' and 'oscillation_ctrl/worlds' to 'PX4-Autopilot/Tools/sitl_gazebo/models' and 'PX4-Autopilot/Tools/sitl_gazebo/worlds' respectively
|
||||||
|
### ROMFS/PX4FMU_COMMON
|
||||||
|
copy (or add) files in 'oscillation_ctrl/airframes' to 'PX4-Autopilot/ROMFS/px4fmu_common/init.d-posix/airframes'
|
||||||
|
add file name to 'CmakeLists.txt' in same 'airframe' folder (with number)
|
||||||
|
add airframe name in '~/PX4-Autopilot/platforms/posix/cmake/sitl_target.cmake' (no number!)
|
||||||
|
### LAUNCH FILES
|
||||||
|
copy (or add) files from px4_launch directory to '~/PX4-Autopilot/launch'
|
||||||
|
### MAVROS
|
||||||
|
- in px4.launch, replace:
|
||||||
|
'''
|
||||||
|
arg name="fcu_url" default="/dev/ttyACM0:57600"
|
||||||
|
arg name="gcs_url" default="udp-b://127.0.0.1:14555@14550"
|
||||||
|
'''
|
||||||
|
- with:
|
||||||
|
|
||||||
|
arg name="fcu_url" default="udp://:14551@192.168.1.91:14556"
|
||||||
|
arg name="gcs_url" default="udp-b://127.0.0.1:14555@14550"
|
||||||
|
|
||||||
|
#### CHANGE DEVEL/SETUP.BASH
|
||||||
|
In catkin_ws (or any working directory) add to devel/setup.bash:
|
||||||
|
CURRENT_DIR=$(pwd)
|
||||||
|
cd ~/PX4-Autopilot
|
||||||
|
|
||||||
|
source Tools/setup_gazebo.bash $(pwd) $(pwd)/build/px4_sitl_default
|
||||||
|
export ROS_PACKAGE_PATH=$ROS_PACKAGE_PATH:$(pwd)
|
||||||
|
export ROS_PACKAGE_PATH=$ROS_PACKAGE_PATH:$(pwd)/Tools/sitl_gazebo
|
||||||
|
|
||||||
|
cd $CURRENT_DIR
|
||||||
|
|
||||||
|
## JINJA TETHER FILE
|
||||||
|
- spiri_with_tether.sdf.jinja can be altered to create desired tether model
|
||||||
|
- changes nede to be made in px4 directory and will only take effect and
|
||||||
|
"make px4_sitl gazebo"
|
||||||
|
- can do DONT_RUN=1 make px4_sitl gazebo to avoid starting px4 shell and gazebo
|
||||||
|
- First two elements can be changed to tweak tether parameters
|
||||||
|
- number_elements: number of segments tether will be composed of
|
||||||
|
- tl: segment length (should be no shorter than 0.3 meters)
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
|
||||||
|
|
@ -0,0 +1,58 @@
|
||||||
|
<?xml version="1.0" encoding="UTF-8"?>
|
||||||
|
<launch>
|
||||||
|
<!-- MAVROS posix SITL environment launch script -->
|
||||||
|
<!-- launches MAVROS, PX4 SITL, Gazebo environment, and spawns vehicle -->
|
||||||
|
<!-- vehicle pose -->
|
||||||
|
<arg name="x" default="0"/>
|
||||||
|
<arg name="y" default="0"/>
|
||||||
|
<arg name="z" default="0"/>
|
||||||
|
<arg name="R" default="0"/>
|
||||||
|
<arg name="P" default="0"/>
|
||||||
|
<arg name="Y" default="0"/>
|
||||||
|
<!-- vehicle model and world -->
|
||||||
|
<arg name="est" default="ekf2"/>
|
||||||
|
<arg name="vehicle" default="spiri"/>
|
||||||
|
<arg name="world" default="$(find mavlink_sitl_gazebo)/worlds/citadel_hill_world.world"/>
|
||||||
|
<arg name="sdf" default="$(find mavlink_sitl_gazebo)/models/$(arg vehicle)/$(arg vehicle).sdf"/>
|
||||||
|
|
||||||
|
<!-- gazebo configs -->
|
||||||
|
<arg name="gui" default="true"/>
|
||||||
|
<arg name="debug" default="false"/>
|
||||||
|
<arg name="verbose" default="false"/>
|
||||||
|
<arg name="paused" default="false"/>
|
||||||
|
<arg name="respawn_gazebo" default="false"/>
|
||||||
|
<!-- MAVROS configs -->
|
||||||
|
<arg name="fcu_url" default="udp://:14540@localhost:14557"/>
|
||||||
|
<arg name="respawn_mavros" default="false"/>
|
||||||
|
<!-- PX4 configs -->
|
||||||
|
<arg name="interactive" default="true"/>
|
||||||
|
<!-- PX4 SITL and Gazebo -->
|
||||||
|
<include file="$(find px4)/launch/posix_sitl.launch">
|
||||||
|
<arg name="x" value="$(arg x)"/>
|
||||||
|
<arg name="y" value="$(arg y)"/>
|
||||||
|
<arg name="z" value="$(arg z)"/>
|
||||||
|
<arg name="R" value="$(arg R)"/>
|
||||||
|
<arg name="P" value="$(arg P)"/>
|
||||||
|
<arg name="Y" value="$(arg Y)"/>
|
||||||
|
<arg name="world" value="$(arg world)"/>
|
||||||
|
<arg name="vehicle" value="$(arg vehicle)"/>
|
||||||
|
<arg name="sdf" value="$(arg sdf)"/>
|
||||||
|
<arg name="gui" value="$(arg gui)"/>
|
||||||
|
<arg name="interactive" value="$(arg interactive)"/>
|
||||||
|
<arg name="debug" value="$(arg debug)"/>
|
||||||
|
<arg name="verbose" value="$(arg verbose)"/>
|
||||||
|
<arg name="paused" value="$(arg paused)"/>
|
||||||
|
<arg name="respawn_gazebo" value="$(arg respawn_gazebo)"/>
|
||||||
|
</include>
|
||||||
|
<!-- MAVROS -->
|
||||||
|
<include file="$(find mavros)/launch/px4.launch">
|
||||||
|
<!-- GCS link is provided by SITL -->
|
||||||
|
<arg name="gcs_url" value=""/>
|
||||||
|
<arg name="fcu_url" value="$(arg fcu_url)"/>
|
||||||
|
<arg name="respawn_mavros" value="$(arg respawn_mavros)"/>
|
||||||
|
</include>
|
||||||
|
</launch>
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
@ -0,0 +1,58 @@
|
||||||
|
<?xml version="1.0" encoding="UTF-8"?>
|
||||||
|
<launch>
|
||||||
|
<!-- MAVROS posix SITL environment launch script -->
|
||||||
|
<!-- launches MAVROS, PX4 SITL, Gazebo environment, and spawns vehicle -->
|
||||||
|
<!-- vehicle pose -->
|
||||||
|
<arg name="x" default="0"/>
|
||||||
|
<arg name="y" default="0"/>
|
||||||
|
<arg name="z" default="0"/>
|
||||||
|
<arg name="R" default="0"/>
|
||||||
|
<arg name="P" default="0"/>
|
||||||
|
<arg name="Y" default="0"/>
|
||||||
|
<!-- vehicle model and world -->
|
||||||
|
<arg name="est" default="ekf2"/>
|
||||||
|
<arg name="vehicle" default="spiri"/>
|
||||||
|
<arg name="world" default="$(find mavlink_sitl_gazebo)/worlds/citadel_hill_world.world"/>
|
||||||
|
<arg name="sdf" default="$(find mavlink_sitl_gazebo)/models/$(arg vehicle)/$(arg vehicle).sdf"/>
|
||||||
|
|
||||||
|
<!-- gazebo configs -->
|
||||||
|
<arg name="gui" default="false"/>
|
||||||
|
<arg name="debug" default="false"/>
|
||||||
|
<arg name="verbose" default="false"/>
|
||||||
|
<arg name="paused" default="false"/>
|
||||||
|
<arg name="respawn_gazebo" default="false"/>
|
||||||
|
<!-- MAVROS configs -->
|
||||||
|
<arg name="fcu_url" default="udp://:14540@localhost:14557"/>
|
||||||
|
<arg name="respawn_mavros" default="false"/>
|
||||||
|
<!-- PX4 configs -->
|
||||||
|
<arg name="interactive" default="true"/>
|
||||||
|
<!-- PX4 SITL and Gazebo -->
|
||||||
|
<include file="$(find px4)/launch/posix_sitl.launch">
|
||||||
|
<arg name="x" value="$(arg x)"/>
|
||||||
|
<arg name="y" value="$(arg y)"/>
|
||||||
|
<arg name="z" value="$(arg z)"/>
|
||||||
|
<arg name="R" value="$(arg R)"/>
|
||||||
|
<arg name="P" value="$(arg P)"/>
|
||||||
|
<arg name="Y" value="$(arg Y)"/>
|
||||||
|
<arg name="world" value="$(arg world)"/>
|
||||||
|
<arg name="vehicle" value="$(arg vehicle)"/>
|
||||||
|
<arg name="sdf" value="$(arg sdf)"/>
|
||||||
|
<arg name="gui" value="$(arg gui)"/>
|
||||||
|
<arg name="interactive" value="$(arg interactive)"/>
|
||||||
|
<arg name="debug" value="$(arg debug)"/>
|
||||||
|
<arg name="verbose" value="$(arg verbose)"/>
|
||||||
|
<arg name="paused" value="$(arg paused)"/>
|
||||||
|
<arg name="respawn_gazebo" value="$(arg respawn_gazebo)"/>
|
||||||
|
</include>
|
||||||
|
<!-- MAVROS -->
|
||||||
|
<include file="$(find mavros)/launch/px4.launch">
|
||||||
|
<!-- GCS link is provided by SITL -->
|
||||||
|
<arg name="gcs_url" value=""/>
|
||||||
|
<arg name="fcu_url" value="$(arg fcu_url)"/>
|
||||||
|
<arg name="respawn_mavros" value="$(arg respawn_mavros)"/>
|
||||||
|
</include>
|
||||||
|
</launch>
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
@ -0,0 +1,54 @@
|
||||||
|
<?xml version="1.0"?>
|
||||||
|
<launch>
|
||||||
|
<!-- MAVROS posix SITL environment launch script -->
|
||||||
|
<!-- launches MAVROS, PX4 SITL, Gazebo environment, and spawns vehicle -->
|
||||||
|
<!-- vehicle pose -->
|
||||||
|
<arg name="x" default="0"/>
|
||||||
|
<arg name="y" default="0"/>
|
||||||
|
<arg name="z" default="0"/>
|
||||||
|
<arg name="R" default="0"/>
|
||||||
|
<arg name="P" default="0"/>
|
||||||
|
<arg name="Y" default="0"/>
|
||||||
|
<!-- vehicle model and world -->
|
||||||
|
<arg name="est" default="ekf2"/>
|
||||||
|
<arg name="vehicle" default="spiri"/>
|
||||||
|
<arg name="world" default="$(find mavlink_sitl_gazebo)/worlds/citadel_hill_world.world"/>
|
||||||
|
<arg name="sdf" default="$(find mavlink_sitl_gazebo)/models/$(arg vehicle)/$(arg vehicle).sdf"/>
|
||||||
|
|
||||||
|
<!-- gazebo configs -->
|
||||||
|
<arg name="gui" default="false"/>
|
||||||
|
<arg name="debug" default="false"/>
|
||||||
|
<arg name="verbose" default="false"/>
|
||||||
|
<arg name="paused" default="false"/>
|
||||||
|
<arg name="respawn_gazebo" default="false"/>
|
||||||
|
<!-- MAVROS configs -->
|
||||||
|
<arg name="fcu_url" default="udp://:14540@localhost:14557"/>
|
||||||
|
<arg name="respawn_mavros" default="false"/>
|
||||||
|
<!-- PX4 configs -->
|
||||||
|
<arg name="interactive" default="true"/>
|
||||||
|
<!-- PX4 SITL and Gazebo -->
|
||||||
|
<include file="$(find px4)/launch/posix_sitl.launch">
|
||||||
|
<arg name="x" value="$(arg x)"/>
|
||||||
|
<arg name="y" value="$(arg y)"/>
|
||||||
|
<arg name="z" value="$(arg z)"/>
|
||||||
|
<arg name="R" value="$(arg R)"/>
|
||||||
|
<arg name="P" value="$(arg P)"/>
|
||||||
|
<arg name="Y" value="$(arg Y)"/>
|
||||||
|
<arg name="world" value="$(arg world)"/>
|
||||||
|
<arg name="vehicle" value="$(arg vehicle)"/>
|
||||||
|
<arg name="sdf" value="$(arg sdf)"/>
|
||||||
|
<arg name="gui" value="$(arg gui)"/>
|
||||||
|
<arg name="interactive" value="$(arg interactive)"/>
|
||||||
|
<arg name="debug" value="$(arg debug)"/>
|
||||||
|
<arg name="verbose" value="$(arg verbose)"/>
|
||||||
|
<arg name="paused" value="$(arg paused)"/>
|
||||||
|
<arg name="respawn_gazebo" value="$(arg respawn_gazebo)"/>
|
||||||
|
</include>
|
||||||
|
<!-- MAVROS -->
|
||||||
|
<include file="$(find mavros)/launch/px4.launch">
|
||||||
|
<!-- GCS link is provided by SITL -->
|
||||||
|
<arg name="gcs_url" value=""/>
|
||||||
|
<arg name="fcu_url" value="$(arg fcu_url)"/>
|
||||||
|
<arg name="respawn_mavros" value="$(arg respawn_mavros)"/>
|
||||||
|
</include>
|
||||||
|
</launch>
|
||||||
|
|
@ -0,0 +1,54 @@
|
||||||
|
<?xml version="1.0"?>
|
||||||
|
<launch>
|
||||||
|
<!-- MAVROS posix SITL environment launch script -->
|
||||||
|
<!-- launches MAVROS, PX4 SITL, Gazebo environment, and spawns vehicle -->
|
||||||
|
<!-- vehicle pose -->
|
||||||
|
<arg name="x" default="0"/>
|
||||||
|
<arg name="y" default="0"/>
|
||||||
|
<arg name="z" default="0"/>
|
||||||
|
<arg name="R" default="0"/>
|
||||||
|
<arg name="P" default="0"/>
|
||||||
|
<arg name="Y" default="0"/>
|
||||||
|
<!-- vehicle model and world -->
|
||||||
|
<arg name="est" default="ekf2"/>
|
||||||
|
<arg name="vehicle" default="spiri_with_tether"/>
|
||||||
|
<arg name="world" default="$(find mavlink_sitl_gazebo)/worlds/citadel_hill_world.world"/>
|
||||||
|
<arg name="sdf" default="$(find mavlink_sitl_gazebo)/models/$(arg vehicle)/$(arg vehicle).sdf"/>
|
||||||
|
|
||||||
|
<!-- gazebo configs -->
|
||||||
|
<arg name="gui" default="false"/>
|
||||||
|
<arg name="debug" default="false"/>
|
||||||
|
<arg name="verbose" default="false"/>
|
||||||
|
<arg name="paused" default="false"/>
|
||||||
|
<arg name="respawn_gazebo" default="false"/>
|
||||||
|
<!-- MAVROS configs -->
|
||||||
|
<arg name="fcu_url" default="udp://:14540@localhost:14557"/>
|
||||||
|
<arg name="respawn_mavros" default="false"/>
|
||||||
|
<!-- PX4 configs -->
|
||||||
|
<arg name="interactive" default="true"/>
|
||||||
|
<!-- PX4 SITL and Gazebo -->
|
||||||
|
<include file="$(find px4)/launch/posix_sitl.launch">
|
||||||
|
<arg name="x" value="$(arg x)"/>
|
||||||
|
<arg name="y" value="$(arg y)"/>
|
||||||
|
<arg name="z" value="$(arg z)"/>
|
||||||
|
<arg name="R" value="$(arg R)"/>
|
||||||
|
<arg name="P" value="$(arg P)"/>
|
||||||
|
<arg name="Y" value="$(arg Y)"/>
|
||||||
|
<arg name="world" value="$(arg world)"/>
|
||||||
|
<arg name="vehicle" value="$(arg vehicle)"/>
|
||||||
|
<arg name="sdf" value="$(arg sdf)"/>
|
||||||
|
<arg name="gui" value="$(arg gui)"/>
|
||||||
|
<arg name="interactive" value="$(arg interactive)"/>
|
||||||
|
<arg name="debug" value="$(arg debug)"/>
|
||||||
|
<arg name="verbose" value="$(arg verbose)"/>
|
||||||
|
<arg name="paused" value="$(arg paused)"/>
|
||||||
|
<arg name="respawn_gazebo" value="$(arg respawn_gazebo)"/>
|
||||||
|
</include>
|
||||||
|
<!-- MAVROS -->
|
||||||
|
<include file="$(find mavros)/launch/px4.launch">
|
||||||
|
<!-- GCS link is provided by SITL -->
|
||||||
|
<arg name="gcs_url" value=""/>
|
||||||
|
<arg name="fcu_url" value="$(arg fcu_url)"/>
|
||||||
|
<arg name="respawn_mavros" value="$(arg respawn_mavros)"/>
|
||||||
|
</include>
|
||||||
|
</launch>
|
||||||
|
|
@ -0,0 +1,56 @@
|
||||||
|
<?xml version="1.0"?>
|
||||||
|
<launch>
|
||||||
|
<!-- MAVROS posix SITL environment launch script -->
|
||||||
|
<!-- launches MAVROS, PX4 SITL, Gazebo environment, and spawns vehicle -->
|
||||||
|
<!-- vehicle pose -->
|
||||||
|
<arg name="x" default="0"/>
|
||||||
|
<arg name="y" default="0"/>
|
||||||
|
<arg name="z" default="0"/>
|
||||||
|
<arg name="R" default="0"/>
|
||||||
|
<arg name="P" default="0"/>
|
||||||
|
<arg name="Y" default="0"/>
|
||||||
|
<!-- vehicle model and world -->
|
||||||
|
<arg name="est" default="ekf2"/>
|
||||||
|
<arg name="vehicle" default="spiri"/>
|
||||||
|
<arg name="world" default="$(find mavlink_sitl_gazebo)/worlds/citadel_hill_world.world"/>
|
||||||
|
<arg name="sdf" default="$(find mavlink_sitl_gazebo)/models/$(arg vehicle)/$(arg vehicle).sdf"/>
|
||||||
|
|
||||||
|
<!-- gazebo configs -->
|
||||||
|
<arg name="gui" default="true"/>
|
||||||
|
<arg name="debug" default="false"/>
|
||||||
|
<arg name="verbose" default="false"/>
|
||||||
|
<arg name="paused" default="false"/>
|
||||||
|
<arg name="respawn_gazebo" default="false"/>
|
||||||
|
<!-- MAVROS configs -->
|
||||||
|
<arg name="fcu_url" default="udp://:14540@localhost:14557"/>
|
||||||
|
<arg name="respawn_mavros" default="false"/>
|
||||||
|
<arg name="quaternion" default="true"/>
|
||||||
|
<!-- PX4 configs -->
|
||||||
|
<arg name="interactive" default="true"/>
|
||||||
|
<!-- PX4 SITL and Gazebo -->
|
||||||
|
<include file="$(find px4)/launch/posix_sitl.launch">
|
||||||
|
<arg name="x" value="$(arg x)"/>
|
||||||
|
<arg name="y" value="$(arg y)"/>
|
||||||
|
<arg name="z" value="$(arg z)"/>
|
||||||
|
<arg name="R" value="$(arg R)"/>
|
||||||
|
<arg name="P" value="$(arg P)"/>
|
||||||
|
<arg name="Y" value="$(arg Y)"/>
|
||||||
|
<arg name="world" value="$(arg world)"/>
|
||||||
|
<arg name="vehicle" value="$(arg vehicle)"/>
|
||||||
|
<arg name="sdf" value="$(arg sdf)"/>
|
||||||
|
<arg name="gui" value="$(arg gui)"/>
|
||||||
|
<arg name="interactive" value="$(arg interactive)"/>
|
||||||
|
<arg name="debug" value="$(arg debug)"/>
|
||||||
|
<arg name="verbose" value="$(arg verbose)"/>
|
||||||
|
<arg name="paused" value="$(arg paused)"/>
|
||||||
|
<arg name="respawn_gazebo" value="$(arg respawn_gazebo)"/>
|
||||||
|
</include>
|
||||||
|
<!-- MAVROS -->
|
||||||
|
<include file="$(find mavros)/launch/px4.launch">
|
||||||
|
<!-- GCS link is provided by SITL -->
|
||||||
|
<arg name="gcs_url" value=""/>
|
||||||
|
<arg name="fcu_url" value="$(arg fcu_url)"/>
|
||||||
|
<arg name="respawn_mavros" value="$(arg respawn_mavros)"/>
|
||||||
|
<arg name="quaternion" value="$(arg quaternion)"/>
|
||||||
|
</include>
|
||||||
|
</launch>
|
||||||
|
|
@ -0,0 +1,54 @@
|
||||||
|
<?xml version="1.0"?>
|
||||||
|
<launch>
|
||||||
|
<!-- MAVROS posix SITL environment launch script -->
|
||||||
|
<!-- launches MAVROS, PX4 SITL, Gazebo environment, and spawns vehicle -->
|
||||||
|
<!-- vehicle pose -->
|
||||||
|
<arg name="x" default="0"/>
|
||||||
|
<arg name="y" default="0"/>
|
||||||
|
<arg name="z" default="0"/>
|
||||||
|
<arg name="R" default="0"/>
|
||||||
|
<arg name="P" default="0"/>
|
||||||
|
<arg name="Y" default="0"/>
|
||||||
|
<!-- vehicle model and world -->
|
||||||
|
<arg name="est" default="ekf2"/>
|
||||||
|
<arg name="vehicle" default="spiri_with_tether"/>
|
||||||
|
<arg name="world" default="$(find mavlink_sitl_gazebo)/worlds/citadel_hill_world.world"/>
|
||||||
|
<arg name="sdf" default="$(find mavlink_sitl_gazebo)/models/$(arg vehicle)/$(arg vehicle).sdf"/>
|
||||||
|
|
||||||
|
<!-- gazebo configs -->
|
||||||
|
<arg name="gui" default="true"/>
|
||||||
|
<arg name="debug" default="false"/>
|
||||||
|
<arg name="verbose" default="false"/>
|
||||||
|
<arg name="paused" default="false"/>
|
||||||
|
<arg name="respawn_gazebo" default="false"/>
|
||||||
|
<!-- MAVROS configs -->
|
||||||
|
<arg name="fcu_url" default="udp://:14540@localhost:14557"/>
|
||||||
|
<arg name="respawn_mavros" default="false"/>
|
||||||
|
<!-- PX4 configs -->
|
||||||
|
<arg name="interactive" default="true"/>
|
||||||
|
<!-- PX4 SITL and Gazebo -->
|
||||||
|
<include file="$(find px4)/launch/posix_sitl.launch">
|
||||||
|
<arg name="x" value="$(arg x)"/>
|
||||||
|
<arg name="y" value="$(arg y)"/>
|
||||||
|
<arg name="z" value="$(arg z)"/>
|
||||||
|
<arg name="R" value="$(arg R)"/>
|
||||||
|
<arg name="P" value="$(arg P)"/>
|
||||||
|
<arg name="Y" value="$(arg Y)"/>
|
||||||
|
<arg name="world" value="$(arg world)"/>
|
||||||
|
<arg name="vehicle" value="$(arg vehicle)"/>
|
||||||
|
<arg name="sdf" value="$(arg sdf)"/>
|
||||||
|
<arg name="gui" value="$(arg gui)"/>
|
||||||
|
<arg name="interactive" value="$(arg interactive)"/>
|
||||||
|
<arg name="debug" value="$(arg debug)"/>
|
||||||
|
<arg name="verbose" value="$(arg verbose)"/>
|
||||||
|
<arg name="paused" value="$(arg paused)"/>
|
||||||
|
<arg name="respawn_gazebo" value="$(arg respawn_gazebo)"/>
|
||||||
|
</include>
|
||||||
|
<!-- MAVROS -->
|
||||||
|
<include file="$(find mavros)/launch/px4.launch">
|
||||||
|
<!-- GCS link is provided by SITL -->
|
||||||
|
<arg name="gcs_url" value=""/>
|
||||||
|
<arg name="fcu_url" value="$(arg fcu_url)"/>
|
||||||
|
<arg name="respawn_mavros" value="$(arg respawn_mavros)"/>
|
||||||
|
</include>
|
||||||
|
</launch>
|
||||||
14
setup.txt
14
setup.txt
|
|
@ -83,17 +83,14 @@ STEP 3) This is Cesar stuff, need to do stuff to rebuild oscillation_ctrl
|
||||||
catkin build
|
catkin build
|
||||||
source ~/catkin_ws/devel/setup.bash
|
source ~/catkin_ws/devel/setup.bash
|
||||||
~Troubleshooting: https://github.com/Jaeyoung-Lim/mavros_controllers
|
~Troubleshooting: https://github.com/Jaeyoung-Lim/mavros_controllers
|
||||||
|
|
||||||
-TOOLS/SITL_GAZEBO
|
-TOOLS/SITL_GAZEBO
|
||||||
change default sitl_gazebo folder with working folder
|
copy (or add) files in oscillation_ctrl/models and oscillation_ctrl/worlds to PX4-Autopilot/Tools/sitl_gazebo/models and PX4-Autopilot/Tools/sitl_gazebo/worlds respectively
|
||||||
-- Change this to add model, change airframe, etc and add citadel_hill world
|
|
||||||
-ROMFS/PX4FMU_COMMON
|
-ROMFS/PX4FMU_COMMON
|
||||||
add files in oscillation_ctrl/models and oscillation_ctrl/worlds to PX4-Autopilot/Tools/sitl_gazebo/models and PX4-Autopilot/Tools/sitl_gazebo/worlds respectively
|
copy (or add) files in oscillation_ctrl/airframes to PX4-Autopilot/ROMFS/px4fmu_common/init.d-posix/airframes
|
||||||
add files in oscillation_ctrl/airframes to PX4-Autopilot/ROMFS/px4fmu_common/init.d-posix
|
|
||||||
add file name to CmakeLists.txt in same 'airframe' folder (with number)
|
add file name to CmakeLists.txt in same 'airframe' folder (with number)
|
||||||
add airframe name in ~/PX4-Autopilot/platforms/posix/cmake/sitl_target.cmake (no number!)
|
add airframe name in ~/PX4-Autopilot/platforms/posix/cmake/sitl_target.cmake (no number!)
|
||||||
-LAUNCH FILES
|
-LAUNCH FILES
|
||||||
change default ~/PX4-Autopilot/launch folder with working folder
|
ccopy (or add) files from px4_launch directory to ~/PX4-Autopilot/launch
|
||||||
-MAVROS
|
-MAVROS
|
||||||
- in px4.launch, replace:
|
- in px4.launch, replace:
|
||||||
<arg name="fcu_url" default="/dev/ttyACM0:57600" />
|
<arg name="fcu_url" default="/dev/ttyACM0:57600" />
|
||||||
|
|
@ -112,6 +109,11 @@ STEP 3) This is Cesar stuff, need to do stuff to rebuild oscillation_ctrl
|
||||||
|
|
||||||
cd $CURRENT_DIR
|
cd $CURRENT_DIR
|
||||||
|
|
||||||
|
JINJA TETHER FILE
|
||||||
|
- First two elements can be changed to tweak tether parameters
|
||||||
|
- number_elements: number of segments tether will be composed of
|
||||||
|
- tl: segment length (should be no shorter than 0.3 meters)
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
|
||||||
Loading…
Reference in New Issue