Python QuickBotSupervisor.process_state_info Examples

Example #1

File: week6.py Project: altexdim/pysimiam-original-fork

    def process_state_info(self,state):
        """Update state parameters for the controllers and self"""

        QuickBotSupervisor.process_state_info(self,state)
        
        # Sensor readings in world units
        self.parameters.sensor_distances = self.get_ir_distances()
        self.parameters.pose = self.pose_est

Example #2

    def process_state_info(self, state):
        """Update state parameters for the controllers and self"""

        QuickBotSupervisor.process_state_info(self, state)

        # Sensor readings in world units
        self.parameters.sensor_distances = self.get_ir_distances()
        self.parameters.pose = self.pose_est

Example #3

File: week3.py Project: PRA-Robotics/piduino_quickbot

    def process_state_info(self, state):
        """Update state parameters for the controllers and self"""

        QuickBotSupervisor.process_state_info(self, state)

        # The pose for controllers
        self.parameters.pose = self.pose_est

        # Update the trajectory
        self.tracker.add_point(self.pose_est)

Example #4

File: week3.py Project: altexdim/pysimiam-original-fork

    def process_state_info(self, state):
        """Update state parameters for the controllers and self"""

        QuickBotSupervisor.process_state_info(self,state)

        # The pose for controllers
        self.parameters.pose = self.pose_est
        
        # Update the trajectory
        self.tracker.add_point(self.pose_est)

Example #5

File: quickbotdefaultsupervisor.py Project: altexdim/pysimiam-original-fork

    def process_state_info(self, state):
        """Update state parameters for the controllers and self"""

        QuickBotSupervisor.process_state_info(self,state)

        # The pose for controllers
        self.parameters.pose = self.pose_est
        # Sensor readings in real units
        self.parameters.sensor_distances = self.get_ir_distances()
        
        # Distance to the goal
        self.distance_from_goal = sqrt((self.pose_est.x - self.parameters.goal.x)**2 + (self.pose_est.y - self.parameters.goal.y)**2)
          
        return self.parameters

Example #6

File: quickbotdefaultsupervisor.py Project: PRA-Robotics/piduino_quickbot

    def process_state_info(self, state):
        """Update state parameters for the controllers and self"""

        QuickBotSupervisor.process_state_info(self, state)

        # The pose for controllers
        self.parameters.pose = self.pose_est
        # Sensor readings in real units
        self.parameters.sensor_distances = self.get_ir_distances()

        # Distance to the goal
        self.distance_from_goal = sqrt(
            (self.pose_est.x - self.parameters.goal.x)**2 +
            (self.pose_est.y - self.parameters.goal.y)**2)

        return self.parameters

Example #7

File: week7.py Project: rahulratheesh/pysimiam

    def process_state_info(self, state):
        """Update state parameters for the controllers and self"""

        QuickBotSupervisor.process_state_info(self,state)

        # The pose for controllers
        self.parameters.pose = self.pose_est

        # Distance to the goal
        # Added for swarm robots
        goal = goal_location[(self.robot.robot_id + 1)%4]
        self.distance_from_goal = sqrt((self.pose_est.x - goal.x)**2 + (self.pose_est.y - goal.y)**2)
            
        #self.distance_from_goal = sqrt((self.pose_est.x - self.parameters.goal.x)**2 + (self.pose_est.y - self.parameters.goal.y)**2)
        
        # Sensor readings in real units
        self.parameters.sensor_distances = self.get_ir_distances()
        
        # Distance to the closest obstacle        
        self.distmin = min(self.parameters.sensor_distances)