Moving a static object with setmodelstate
Hi! I have a little piece of code in Python that uses the SetModelState service to move objects in the simulation programmatically.
It works perfectly with not static objects, but static ones won't move. Is there any way to fix this?
Thanks!
I paste the code here:
# coding=utf-8
import rospy
import rospkg
from gazebo_msgs.srv import GetModelState
from gazebo_msgs.msg import ModelState
from gazebo_msgs.srv import SetModelState
def set_item(goal_x, goal_y,goal_z,objeto):
state_msg = ModelState()
state_msg.model_name = objeto
state_msg.pose.position.x = goal_x
state_msg.pose.position.y = goal_y
state_msg.pose.position.z = goal_z
state_msg.pose.orientation.x = 1
state_msg.pose.orientation.y = 0
state_msg.pose.orientation.z = 0
state_msg.pose.orientation.w = 0
rospy.wait_for_service('/gazebo/set_model_state')
try:
set_state = rospy.ServiceProxy(
'/gazebo/set_model_state', SetModelState)
resp = set_state(state_msg)
print(state_msg)
except rospy.ServiceException, e:
print "Service call failed: %s" % e
Asked by Pablowally on 2019-10-01 10:22:20 UTC
Comments