前段時間寫了文章，通過修改sdf、urdf模型的方法，在Gazebo中添加懸浮模型方法 / Gazebo中模型如何不因重力下落：在Gazebo中添加懸浮模型方法 / Gazebo中模型如何不因重力下落：修改sdf、urdf模型_sagima_sdu的博客-CSDN博客

今天講一下如何通過鍵盤來控制其移動：監聽鍵盤輸入并根據按鍵調整模型的位置，然后通過調用set_model_state函數來更新模型在Gazebo中的狀態

程序舉例：

首先，我們先通過一個程序，實現在指定的空間坐標生成一個指定的模型

（注意，如果要使用的話，需要修改程序中指定的模型名稱和模型的路徑）

# -*- coding: utf-8 -*-
#!/usr/bin/env python"""
Author：sagima使用Gazebo仿真環境中生成一個名為"aruco_cubo_hover"的模型
python model.py
程序運行在Python2.7環境下。
"""import os
import rospy
from gazebo_msgs.msg import ModelState
from gazebo_msgs.srv import DeleteModel, SpawnModel
from std_msgs.msg import Header
from geometry_msgs.msg import Pose, Point# 初始化ROS節點
rospy.init_node('spawn_aruco_cubo_hover', anonymous=True)# 定義生成模型的函數
def spawn_aruco_cubo_hover():model_name = "aruco_cubo_hover"model_path = "/home/sjh/project/Tiago_ws/src/pal_gazebo_worlds/models/aruco_cube_hover/aruco_cube_hover.sdf"# 在這里修改目標位置initial_pose = Pose(position=Point(x=0.8, y=0, z=1))# 從文件加載模型with open(model_path, "r") as f:model_xml = f.read()# 調用Gazebo的SpawnModel服務spawn_model = rospy.ServiceProxy('/gazebo/spawn_sdf_model', SpawnModel)resp_sdf = spawn_model(model_name, model_xml, "", initial_pose, "world")if resp_sdf.success:rospy.loginfo("模型 '{}' 生成成功。".format(model_name))else:rospy.logerr("模型 '{}' 生成失敗。".format(model_name))# 調用生成模型的函數
if __name__ == '__main__':try:spawn_aruco_cubo_hover()except rospy.ROSInterruptException:pass

上面的程序沒有問題的話，就可以為其加入通過鍵盤控制的功能了

# -*- coding: utf-8 -*-
#!/usr/bin/env python"""
Author：sagima使用Gazebo仿真環境中生成一個名為"aruco_cubo_hover"的模型，并通過鍵盤控制模型運動
python model_with_keyboard_control.py
程序運行在Python2.7環境下。
"""import os
import rospy
from gazebo_msgs.msg import ModelState
from gazebo_msgs.srv import SetModelState, GetModelState
from std_msgs.msg import Header
from geometry_msgs.msg import Pose, Point
import sys
import select
import tty
import termios# 初始化ROS節點
rospy.init_node('spawn_aruco_cubo_hover', anonymous=True)# 保存終端設置
old_settings = termios.tcgetattr(sys.stdin)
tty.setcbreak(sys.stdin.fileno())# 定義運動速度
move_speed = 0.1# 定義生成模型的函數
def spawn_aruco_cubo_hover(initial_pose):model_name = "aruco_cubo_hover"model_path = "/home/sjh/project/Tiago_ws/src/pal_gazebo_worlds/models/aruco_cube_hover/aruco_cube_hover.sdf"# 從文件加載模型with open(model_path, "r") as f:model_xml = f.read()# 調用Gazebo的SpawnModel服務spawn_model = rospy.ServiceProxy('/gazebo/spawn_sdf_model', SpawnModel)resp_sdf = spawn_model(model_name, model_xml, "", initial_pose, "world")if resp_sdf.success:rospy.loginfo("模型 '{}' 生成成功。".format(model_name))else:rospy.logerr("模型 '{}' 生成失敗。".format(model_name))# 定義設置模型狀態的函數
def set_model_state(model_name, pose):model_state = ModelState()model_state.model_name = model_namemodel_state.pose = poseset_model_state = rospy.ServiceProxy('/gazebo/set_model_state', SetModelState)set_model_state(model_state)# 中文提示
print("按下以下鍵盤按鍵來控制模型運動：")
print("W: 向前移動")
print("S: 向后移動")
print("A: 向左移動")
print("D: 向右移動")
print("Q: 上升")
print("E: 下降")
print("Ctrl+C: 退出程序")try:# 定義初始位置initial_pose = Pose(position=Point(x=0.8, y=0, z=1))# 主循環，持續監聽鍵盤輸入并控制模型運動while True:if select.select([sys.stdin], [], [], 0)[0] == [sys.stdin]:key = sys.stdin.read(1)if key == 'w':initial_pose.position.x += move_speedelif key == 's':initial_pose.position.x -= move_speedelif key == 'a':initial_pose.position.y += move_speedelif key == 'd':initial_pose.position.y -= move_speedelif key == 'q':initial_pose.position.z += move_speedelif key == 'e':initial_pose.position.z -= move_speedelif key == '\x03':  # Ctrl+Cbreak# 調用設置模型狀態的函數set_model_state("aruco_cubo_hover", initial_pose)
except rospy.ROSInterruptException:pass
finally:# 恢復終端設置termios.tcsetattr(sys.stdin, termios.TCSADRAIN, old_settings)

注意，如果要使用的話，需要修改程序中指定的模型名稱和模型的路徑；同時如果需要修改按鍵，記得在中文提示中一并修改