public void SendWrench(UnityEngine.Vector3 force, UnityEngine.Vector3 torque)
{
if (!init)
{
return;
}
Wrench wrench = new Wrench();
wrench.force = new Messages.geometry_msgs.Vector3(force.ToRos());
wrench.torque = new Messages.geometry_msgs.Vector3(torque.ToRos());
wrenchPub.publish(wrench);
}
public void SendTwist(UnityEngine.Vector3 linear, UnityEngine.Vector3 angular)
{
if (!init)
{
return;
}
Twist twist = new Twist();
twist.linear = new Messages.geometry_msgs.Vector3(linear.ToRos());
twist.angular = new Messages.geometry_msgs.Vector3(angular.ToRos());
velocityPublisher.publish(twist);
}