Mbot2 Line Follower Code May 2026
def search_for_line(self): """ When line is lost, search by rotating slowly Returns: True if line found, False if search timeout """ print("Line lost! Searching...") search_start = time.time() search_duration = 3 # Maximum search time (seconds) while time.time() - search_start < search_duration: sensors = self.read_line_sensors() position = self.calculate_line_position(sensors) if position is not None: print("Line found!") return True # Rotate slowly to search self.bot.set_left_motor_speed(self.MIN_SPEED) self.bot.set_right_motor_speed(-self.MIN_SPEED) time.sleep(0.05) print("Line search failed!") return False
def set_motor_speeds(self, base_speed, turn_speed): """ Calculate and set left/right motor speeds based on base speed and turn """ # Differential steering left_speed = base_speed + turn_speed right_speed = base_speed - turn_speed # Apply speed limits left_speed = max(-self.MAX_SPEED, min(self.MAX_SPEED, left_speed)) right_speed = max(-self.MAX_SPEED, min(self.MAX_SPEED, right_speed)) # Set motor speeds self.bot.set_left_motor_speed(left_speed) self.bot.set_right_motor_speed(right_speed) mbot2 line follower code
def calculate_line_position(self, sensors): """ Calculate the line position as a weighted average Returns: position from -2.0 (far left) to +2.0 (far right), 0.0 = center, None if no line detected """ weighted_sum = 0 total_weight = 0 for i, reading in enumerate(sensors): if reading: # Line detected # Convert index to position: 0=-2, 1=-1, 2=0, 3=1, 4=2 position = i - 2 weighted_sum += position total_weight += 1 if total_weight > 0: return weighted_sum / total_weight else: return None # No line detected def search_for_line(self): """ When line is lost, search
choice = input("\nSelect option: ").strip() left_speed)) right_speed = max(-self.MAX_SPEED