Example #1
0
def set_tilt_profile(position, time_from_start):
    cmd = LaserTrajCmd()
    cmd.profile = 'blended_linear'
    cmd.position = position
    cmd.time_from_start = [rospy.Time.from_sec(x) for x in time_from_start]
    cmd.max_velocity = 10
    cmd.max_acceleration = 30
    try:
        tilt_profile_client.call(cmd)
    except rospy.ServiceException, e:
        rospy.logerr("Couldn't set the profile on the laser. Exception %s" % e)
        return False
Example #2
0
def set_tilt_profile(position, time_from_start):
    cmd = LaserTrajCmd()
    cmd.profile = 'blended_linear'
    cmd.position = position
    cmd.time_from_start = [rospy.Time.from_sec(x) for x in time_from_start]
    cmd.max_velocity = 10
    cmd.max_acceleration = 30
    try:
        tilt_profile_client.call(cmd)
    except rospy.ServiceException, e:
        rospy.logerr("Couldn't set the profile on the laser. Exception %s" % e)
        return False
Example #3
0
from pr2_msgs.srv import *
from time import sleep


def print_usage(exit_code=0):
    print '''Usage:
    send_periodic_cmd.py [controller]
'''
    sys.exit(exit_code)


if __name__ == '__main__':
    if len(sys.argv) < 2:
        print_usage()

    cmd = LaserTrajCmd()
    controller = sys.argv[1]
    cmd.header = rospy.Header(None, None, None)
    cmd.profile = "blended_linear"

    cycle_time = rospy.get_param('~cycle_time', 5.0)
    min_tilt_angle = rospy.get_param('~min_tilt_angle', -0.7)
    max_tilt_angle = rospy.get_param('~max_tilt_angle', 1.0)

    cmd.position = [min_tilt_angle, max_tilt_angle, min_tilt_angle]
    cmd.time_from_start = [0.0, cycle_time - 1.0, cycle_time]
    cmd.time_from_start = [
        rospy.Duration.from_sec(x) for x in cmd.time_from_start
    ]
    cmd.max_velocity = 10
    cmd.max_acceleration = 30
from pr2_msgs.srv import *
from time import sleep

def print_usage(exit_code = 0):
    print '''Usage:
    laser_traj_cmd.py [controller]
'''
    sys.exit(exit_code)

if __name__ == '__main__':
    if len(sys.argv) < 2:
        print_usage()

    rospy.init_node('laser_tilt_commander', anonymous=True)

    cmd = LaserTrajCmd()
    controller   =    sys.argv[1]
    cmd.header.stamp = rospy.get_rostime()
    cmd.profile  = "linear"
    #cmd.pos      = [1.0, .26, -.26, -.7,   -.7,   -.26,   .26,   1.0, 1.0]
    d = .025
    #cmd.time     = [0.0, 0.4,  1.0, 1.1, 1.1+d,  1.2+d, 1.8+d, 2.2+d, 2.2+2*d]
    
    cmd.position = [1.5,  -.7, 1.5]
    #cmd.time_from_start = [0.0, 1.0, 2.0] #[0.0, 0.5, 1.0]
    cmd.time_from_start = [0.0, 4.0, 8.0] #[0.0, 0.5, 1.0]
    cmd.time_from_start = [rospy.Time.from_sec(x) for x in cmd.time_from_start]
    cmd.max_velocity = 5
    cmd.max_acceleration =  5

    print 'Sending Command to %s: ' % controller
from pr2_msgs.srv import *
from time import sleep


def print_usage(exit_code=0):
    print '''Usage:
    send_periodic_cmd.py [controller]
'''
    sys.exit(exit_code)


if __name__ == '__main__':
    if len(sys.argv) < 2:
        print_usage()

    cmd = LaserTrajCmd()
    controller = sys.argv[1]
    cmd.header = rospy.Header(None, None, None)
    cmd.profile = "blended_linear"
    #cmd.pos      = [1.0, .26, -.26, -.7,   -.7,   -.26,   .26,   1.0, 1.0]
    d = .025
    #cmd.time     = [0.0, 0.4,  1.0, 1.1, 1.1+d,  1.2+d, 1.8+d, 2.2+d, 2.2+2*d]

    dur = 15
    cmd.position = [-.7, 1.2, -.7]
    cmd.time_from_start = [0.0, dur, dur + 1]
    cmd.time_from_start = [
        rospy.Duration.from_sec(x) for x in cmd.time_from_start
    ]
    cmd.max_velocity = 10
    cmd.max_acceleration = 30
Example #6
0
from pr2_msgs.srv import *
from time import sleep


def print_usage(exit_code=0):
    print '''Usage:
    send_periodic_cmd.py [controller]
'''
    sys.exit(exit_code)


if __name__ == '__main__':
    #if len(sys.argv) < 2:
    #    print_usage()

    cmd = LaserTrajCmd()
    controller = "laser_tilt_controller"
    cmd.header = rospy.Header(None, None, None)
    cmd.profile = "blended_linear"
    #cmd.pos      = [1.0, .26, -.26, -.7,   -.7,   -.26,   .26,   1.0, 1.0]
    d = .025
    #cmd.time     = [0.0, 0.4,  1.0, 1.1, 1.1+d,  1.2+d, 1.8+d, 2.2+d, 2.2+2*d]

    cmd.position = [1.25, 0.9, 1.25]
    cmd.time_from_start = [0.0, 1.8, 2.025]
    cmd.time_from_start = [
        rospy.Duration.from_sec(x) for x in cmd.time_from_start
    ]

    cmd.max_velocity = 2
    cmd.max_acceleration = 2
Example #7
0
from pr2_msgs.srv import *
from time import sleep


def print_usage(exit_code=0):
    print '''Usage:
    send_periodic_cmd.py [controller]
'''
    sys.exit(exit_code)


if __name__ == '__main__':
    if len(sys.argv) < 2:
        print_usage()

    cmd = LaserTrajCmd()
    controller = sys.argv[1]
    cmd.header = roslib.msg.Header(None, None, None)
    cmd.profile = "blended_linear"
    #cmd.pos      = [1.0, .26, -.26, -.7,   -.7,   -.26,   .26,   1.0, 1.0]
    d = .025
    #cmd.time     = [0.0, 0.4,  1.0, 1.1, 1.1+d,  1.2+d, 1.8+d, 2.2+d, 2.2+2*d]

    cmd.pos = [1.2, -.7, 1.2]
    cmd.time = [0.0, 1.8, 2.025]
    cmd.max_rate = 5  # Ignores param
    cmd.max_accel = 5  # ignores param

    print 'Sending Command to %s: ' % controller
    print '  Profile Type: %s' % cmd.profile
    print '  Pos: %s ' % ','.join(['%.3f' % x for x in cmd.pos])
Example #8
0
import roslib; roslib.load_manifest(PKG) 

import sys
import os
import string

import rospy
from std_msgs import *

from pr2_msgs.msg import LaserTrajCmd
from pr2_msgs.srv import *
from time import sleep


cmd = LaserTrajCmd()
controller   =    'laser_tilt_controller'
cmd.header   =    rospy.Header(None, None, None)
cmd.profile  = "blended_linear"
#cmd.pos      = [1.0, .26, -.26, -.7,   -.7,   -.26,   .26,   1.0, 1.0]
d = .025
#cmd.time     = [0.0, 0.4,  1.0, 1.1, 1.1+d,  1.2+d, 1.8+d, 2.2+d, 2.2+2*d]

dur = 15;
cmd.position = [-1.0,  0, 1]
cmd.time_from_start = [0.0, dur, dur+1]
cmd.time_from_start = [rospy.Duration.from_sec(x) for x in cmd.time_from_start]
cmd.max_velocity = 10
cmd.max_acceleration = 30

print 'Sending Command to %s: ' % controller
from pr2_msgs.msg import LaserTrajCmd
from pr2_msgs.srv import *
from time import sleep

def print_usage(exit_code = 0):
    print '''Usage:
    send_periodic_cmd.py [controller]
'''
    sys.exit(exit_code)

if __name__ == '__main__':
    if len(sys.argv) < 2:
        print_usage()

    cmd = LaserTrajCmd()
    controller   =    sys.argv[1]
    cmd.header   =    rospy.Header(None, None, None)
    cmd.profile  = "blended_linear"
    #cmd.pos      = [1.0, .26, -.26, -.7,   -.7,   -.26,   .26,   1.0, 1.0]
    d = .025
    #cmd.time     = [0.0, 0.4,  1.0, 1.1, 1.1+d,  1.2+d, 1.8+d, 2.2+d, 2.2+2*d]

    cmd.position        = [1.2,  -.7, 1.2]
    cmd.time_from_start = [0.0, 1.8, 2.025]
    cmd.time_from_start = [rospy.Duration.from_sec(x) for x in cmd.time_from_start]

    cmd.max_velocity     =  5
    cmd.max_acceleration =  5

    print 'Sending Command to %s: ' % controller
from pr2_msgs.msg import LaserTrajCmd
from pr2_msgs.srv import *
from time import sleep

def print_usage(exit_code = 0):
    print '''Usage:
    send_periodic_cmd.py [controller]
'''
    sys.exit(exit_code)

if __name__ == '__main__':
    if len(sys.argv) < 2:
        print_usage()

    cmd = LaserTrajCmd()
    controller   =    sys.argv[1]
    cmd.header   =    roslib.msg.Header(None, None, None)
    cmd.profile  = "blended_linear"
    #cmd.pos      = [1.0, .26, -.26, -.7,   -.7,   -.26,   .26,   1.0, 1.0]
    d = .025
    #cmd.time     = [0.0, 0.4,  1.0, 1.1, 1.1+d,  1.2+d, 1.8+d, 2.2+d, 2.2+2*d]
    
    cmd.pos = [-.25,  .50, -.25]
    cmd.time= [0.0, 8.0, 10]
    cmd.max_rate =  5   # Ignores param
    cmd.max_accel=  5   # ignores param

    print 'Sending Command to %s: ' % controller
    print '  Profile Type: %s' % cmd.profile
    print '  Pos: %s ' % ','.join(['%.3f' % x for x in cmd.pos])