def __init__(self, epuck_name, epuck_address, init_xpos, init_ypos, init_theta): self._bridge = ePuck(epuck_address, False) self._name = epuck_name self.enabled_sensors = {s: None for s in sensors} self.prox_publisher = [] self.prox_msg = [] self.theta = init_theta self.x_pos = init_xpos self.y_pos = init_ypos self.leftStepsPrev = 0 self.rightStepsPrev = 0 self.leftStepsDiff = 0 self.rightStepsDiff = 0 self.deltaSteps = 0 self.deltaTheta = 0 self.startTime = time.time() self.endTime = time.time() self.br = tf.TransformBroadcaster()
def __init__(self, epuck_name, epuck_address): self._bridge = ePuck(epuck_address, False) self._name = epuck_name self.enabled_sensors = {sensor_name: None for sensor_name in SENSORS}