#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