32 lines
544 B
Python
32 lines
544 B
Python
#Imports
|
|
import plotutils
|
|
from mathutils import fit_gaussian, Gaussian
|
|
|
|
#Parameters
|
|
RANGE = [-120.0,120.0]
|
|
STEP = 5.0
|
|
LATENCY = 0.005
|
|
RELATIVE = False
|
|
|
|
#Enabling and checking
|
|
#enable_motion()
|
|
#system_check()
|
|
robot.enable()
|
|
|
|
|
|
#Body
|
|
robot.set_tool(TOOL_DEFAULT)
|
|
move_to_laser()
|
|
#robot.set_joint_motors_enabled(True)
|
|
robot.set_motors_enabled(True)
|
|
robot_rz.move(0.0)
|
|
robot.set_motors_enabled(True)
|
|
ret = lscan(robot_rz, ue.readable, RANGE[0], RANGE[1], STEP, latency = LATENCY, relative = RELATIVE, range = "auto", title = "Scan2")
|
|
|
|
|
|
#Cleanup
|
|
|
|
|
|
|
|
|