Answered step by step
Verified Expert Solution
Link Copied!

Question

1 Approved Answer

from controller import Robot robot = Robot() timestep = int(robot.getBasicTimeStep()) time_step = 64 max_speed = 7 #motor left_motor = robot.getDevice('left wheel motor') right_motor = robot.getDevice('right

from controller import Robot

robot = Robot()

timestep = int(robot.getBasicTimeStep())

time_step = 64

max_speed = 7

#motor

left_motor = robot.getDevice('left wheel motor')

right_motor = robot.getDevice('right wheel motor')

left_motor.setPosition(float('inf'))

right_motor.setPosition(float('inf'))

left_motor.setVelocity(0.0)

right_motor.setVelocity(0.0)

#IR sensor

right_ir = robot.getDevice('RIGHT')

right_ir.enable(time_step)

mid_ir = robot.getDevice('MID')

mid_ir.enable(time_step)

left_ir = robot.getDevice('LEFT')

left_ir.enable(time_step)

#simulation

#main loop:

while robot.step(time_step) != -1:

right_ir_val = right_ir.getValue()

mid_ir_val = mid_ir.getValue()

left_ir_val = left_ir.getValue()

print("left: {} mid: {} right: {}".format(left_ir_val, mid_ir_val, right_ir_val))

left_speed = max_speed

right_speed = max_speed

#Process sensor data

if left_ir_val<600 and right_ir_val<600 mid_ir_val>=600:

left_motor.setVelocity(left_speed)

right_motor.setVelocity(right_speed)

if left_ir_val<600 and right_ir_val>=600 and mid_ir_val>=600:

left_motor.setVelocity(left_speed)

right_motor.setVelocity(0)

if left_ir_val>=600 and right_ir_val<600 and mid_ir_val>=600:

left_motor.setVelocity(0)

right_motor.setVelocity(right_speed)

if left_ir_val>=600 and right_ir_val<600 and mid_ir_val<600:

left_motor.setVelocity(0)

right_motor.setVelocity(right_speed)

if left_ir_val<600 and right_ir_val>=600 and mid_ir_val<600:

left_motor.setVelocity(left_speed)

right_motor.setVelocity(0)

if left_ir_val<600 and right_ir_val<600 and mid_ir_val<600:

left_motor.setVelocity(left_speed)

right_motor.setVelocity(right_speed)

pass

Can anyone write the PID controler code in it? I have used wheels here. Please help me

Step by Step Solution

There are 3 Steps involved in it

Step: 1

blur-text-image

Get Instant Access to Expert-Tailored Solutions

See step-by-step solutions with expert insights and AI powered tools for academic success

Step: 2

blur-text-image

Step: 3

blur-text-image

Ace Your Homework with AI

Get the answers you need in no time with our AI-driven, step-by-step assistance

Get Started

Recommended Textbook for

Fundamentals Of Database Systems

Authors: Sham Navathe,Ramez Elmasri

5th Edition

B01FGJTE0Q, 978-0805317558

More Books

Students also viewed these Databases questions

Question

here) and other areas you consider relevant.

Answered: 1 week ago