adding wall follower
This commit is contained in:
parent
83b9aecd7a
commit
9956bb06fb
BIN
docs/static/tutorials/wall-follower.png
vendored
Normal file
BIN
docs/static/tutorials/wall-follower.png
vendored
Normal file
Binary file not shown.
After Width: | Height: | Size: 17 KiB |
@ -25,6 +25,11 @@ Step by step guides to coding your @boardname@.
|
||||
"description": "Use the color sensor to follow line or detect colors",
|
||||
"url":"/tutorials/color-sensor",
|
||||
"imageUrl":"/static/tutorials/what-color.png"
|
||||
}, {
|
||||
"name": "Ultrasonic Sensor",
|
||||
"description": "Use the ultrasonic sensor to detect obstacles",
|
||||
"url":"/tutorials/ultrasonic-sensor",
|
||||
"imageUrl":"/static/tutorials/object-near.png"
|
||||
}, {
|
||||
"name": "Infrared Sensor",
|
||||
"description": "Use the infrared sensor to detect objects",
|
||||
|
@ -4,12 +4,6 @@
|
||||
|
||||
```codecard
|
||||
[{
|
||||
"name": "Object Near",
|
||||
"description": "Detect if objects are near.",
|
||||
"cardType": "tutorial",
|
||||
"url":"/tutorials/object-near",
|
||||
"imageUrl":"/static/tutorials/object-near.png"
|
||||
}, {
|
||||
"name": "Security Alert",
|
||||
"description": "Build an security alert using the Infrared Sensor.",
|
||||
"cardType": "tutorial",
|
||||
@ -20,5 +14,4 @@
|
||||
|
||||
## See Also
|
||||
|
||||
[Object Near?](/tutorials/object-near),
|
||||
[Security Alert](/tutorials/security-alert)
|
||||
|
24
docs/tutorials/ultrasonic-sensor.md
Normal file
24
docs/tutorials/ultrasonic-sensor.md
Normal file
@ -0,0 +1,24 @@
|
||||
# Infrared sensor
|
||||
|
||||
## Tutorials
|
||||
|
||||
```codecard
|
||||
[{
|
||||
"name": "Object Near",
|
||||
"description": "Detect if objects are near.",
|
||||
"cardType": "tutorial",
|
||||
"url":"/tutorials/object-near",
|
||||
"imageUrl":"/static/tutorials/object-near.png"
|
||||
}, {
|
||||
"name": "Wall Follower",
|
||||
"description": "Follow a wall at a distance using the ultrasonic sensor and a proportional controller.",
|
||||
"cardType": "tutorial",
|
||||
"url":"/tutorials/wall-follower",
|
||||
"imageUrl":"/static/tutorials/wall-follower.png"
|
||||
}]
|
||||
```
|
||||
|
||||
## See Also
|
||||
|
||||
[Object Near?](/tutorials/object-near),
|
||||
[Wall Follower](/tutorials/wall-follower)
|
191
docs/tutorials/wall-follower.md
Normal file
191
docs/tutorials/wall-follower.md
Normal file
@ -0,0 +1,191 @@
|
||||
# Wall Follower
|
||||
|
||||
## Introduction @unplugged
|
||||
|
||||
This tutorial shows you how to use the ultrasonic sensor to
|
||||
move a [EV3 Driving Base](https://le-www-live-s.legocdn.com/sc/media/lessons/mindstorms-ev3/building-instructions/ev3-rem-driving-base-79bebfc16bd491186ea9c9069842155e.pdf)
|
||||
along a wall.
|
||||
|
||||
Your ultrasonic sensor should be placed horizontally, near the driving wheel, facing the wall.
|
||||
|
||||
## Step 1 Measure distance
|
||||
|
||||
Declare a new variable ``distance`` and store the distance from
|
||||
the ultrasonic sensor on port 4.
|
||||
|
||||
```blocks
|
||||
let distance = 0
|
||||
forever(function () {
|
||||
distance = sensors.ultrasonic4.distance()
|
||||
})
|
||||
```
|
||||
|
||||
## Step 2 Show distance
|
||||
|
||||
Use a ``||brick:show value||`` block to display the distance value on the screen.
|
||||
This is **very** helpful when you are debugging your code on the robot.
|
||||
|
||||
Once your code is ready, download it to your robot and check that the measured distance looks ok.
|
||||
|
||||
```blocks
|
||||
let distance = 0
|
||||
forever(function () {
|
||||
distance = sensors.ultrasonic4.distance()
|
||||
brick.showValue("distance", distance, 1)
|
||||
})
|
||||
```
|
||||
|
||||
## Step 3 Goal
|
||||
|
||||
Declare a new variable ``goal`` and assign it to ``10`` in ``on start``.
|
||||
The value should be the distance in centimeters between your robot and the wall.
|
||||
|
||||
```blocks
|
||||
let goal = 0
|
||||
goal = 10
|
||||
```
|
||||
|
||||
## Step 4 Compute Error
|
||||
|
||||
Declare a new variable ``error`` and assign a difference between ``distance`` and ``goal``.
|
||||
We will use this value to determine how much the robot needs to correct its trajectory.
|
||||
|
||||
```blocks
|
||||
let distance = 0
|
||||
let goal = 0
|
||||
let error = 0
|
||||
goal = 10
|
||||
forever(function () {
|
||||
distance = sensors.ultrasonic4.distance()
|
||||
brick.showValue("distance", distance, 1)
|
||||
error = distance - goal
|
||||
brick.showValue("error", error, 2)
|
||||
})
|
||||
```
|
||||
|
||||
## Step 5 Show Error
|
||||
|
||||
Just like ``distance``, use ``||brick:show value||`` to display the value of the error (line 2).
|
||||
This will allow you to debug your code while it is running on the robot.
|
||||
|
||||
Download your program to the robot and check that the error goes to ``0`` when
|
||||
the robot is around 10cm from the wall.
|
||||
|
||||
```blocks
|
||||
let distance = 0
|
||||
let goal = 0
|
||||
let error = 0
|
||||
goal = 10
|
||||
forever(function () {
|
||||
distance = sensors.ultrasonic4.distance()
|
||||
brick.showValue("distance", distance, 1)
|
||||
error = distance - goal
|
||||
brick.showValue("error", error, 2)
|
||||
})
|
||||
```
|
||||
|
||||
## Step 6 Kp
|
||||
|
||||
Declare a new variable ``kp`` and assign it to ``1``.
|
||||
This number determines how to convert the error into a ``turn ratio`` for the steer block.
|
||||
For starter, set it to 1 and we will go through the steps to tune its value later on.
|
||||
As usual, also use ``||brick:show value||`` to display the value of ``kp`` on the screen (line 3).
|
||||
|
||||
```blocks
|
||||
let distance = 0
|
||||
let goal = 0
|
||||
let error = 0
|
||||
let kp = 0
|
||||
goal = 10
|
||||
kp = 1
|
||||
forever(function () {
|
||||
distance = sensors.ultrasonic4.distance()
|
||||
brick.showValue("distance", distance, 1)
|
||||
error = distance - goal
|
||||
brick.showValue("error", error, 2)
|
||||
brick.showValue("kp", kp, 3)
|
||||
})
|
||||
```
|
||||
|
||||
## Step 7 Turn ratio
|
||||
|
||||
Declare a new variable ``turnratio`` and store the product of ``error`` and ``kp`` in it.
|
||||
Also use ``||brick:show value||`` to display its value on screen.
|
||||
|
||||
Download the program on the robot and try moving the robot around the wall. You should see
|
||||
the value of ``turnratio`` change similarly to ``error``.
|
||||
|
||||
```blocks
|
||||
let distance = 0
|
||||
let goal = 0
|
||||
let error = 0
|
||||
let kp = 0
|
||||
let turnratio = 0
|
||||
goal = 10
|
||||
kp = 1
|
||||
forever(function () {
|
||||
distance = sensors.ultrasonic4.distance()
|
||||
brick.showValue("distance", distance, 1)
|
||||
error = distance - goal
|
||||
brick.showValue("error", error, 2)
|
||||
brick.showValue("kp", kp, 3)
|
||||
turnratio = error * kp
|
||||
brick.showValue("turn", turnratio, 4)
|
||||
})
|
||||
```
|
||||
|
||||
## Step 8 Steering
|
||||
|
||||
Add a ``||motors:steer motors||`` block for ``large B+C`` at 35% and place the ``turnratio``
|
||||
variable for the turn value.
|
||||
|
||||
Download the code to your robot and try it out. Does it follow the wall?...
|
||||
Not really, this is because we need to tune the ``kp`` variable.
|
||||
|
||||
```blocks
|
||||
let distance = 0
|
||||
let goal = 0
|
||||
let error = 0
|
||||
let kp = 0
|
||||
let turnratio = 0
|
||||
goal = 10
|
||||
kp = 1
|
||||
forever(function () {
|
||||
distance = sensors.ultrasonic4.distance()
|
||||
brick.showValue("distance", distance, 1)
|
||||
error = distance - goal
|
||||
brick.showValue("error", error, 2)
|
||||
brick.showValue("kp", kp, 3)
|
||||
turnratio = error * kp
|
||||
brick.showValue("turn", turnratio, 4)
|
||||
motors.largeBC.steer(turnratio, 35)
|
||||
})
|
||||
```
|
||||
|
||||
## Step 9 Tuning kp
|
||||
|
||||
As mentioned in a previous step, we need to find the right value for kp so that the robot
|
||||
follows the wall properly. This tuning can be tedious so we are going to the brick buttons
|
||||
to speed up the process.
|
||||
|
||||
Add ``||brick:on button||`` blocks to handle the left and right button pressed. When left is pressed, change ``kp`` by ``-1``. When right is pressed, change ``kp`` by 1.
|
||||
|
||||
Download your code to the robot and change the values of ``kp`` until the robot follows the wall. (Tip try something around -5 / -10).
|
||||
|
||||
```blocks
|
||||
let kp = 0
|
||||
brick.buttonLeft.onEvent(ButtonEvent.Pressed, function () {
|
||||
kp += -1
|
||||
})
|
||||
brick.buttonRight.onEvent(ButtonEvent.Pressed, function () {
|
||||
kp += 1
|
||||
})
|
||||
```
|
||||
|
||||
## Step 10 @unplugged
|
||||
|
||||
Well done! Your robot is using the ultrasonic distance
|
||||
to correct is trajectory using a proportional controller!
|
||||
|
||||
The robot will be more precise if it goes slow... Try using a variable
|
||||
and the brick up and down events to control the speed as well.
|
@ -13,6 +13,7 @@
|
||||
"Motor Tutorials": "tutorials/motors",
|
||||
"Touch Sensor Tutorials": "tutorials/touch-sensor",
|
||||
"Color Sensor Tutorials": "tutorials/color-sensor",
|
||||
"Ultrasonic Sensor Tutorials": "tutorials/ultrasonic-sensor",
|
||||
"Infrared Sensor Tutorials": "tutorials/infrared-sensor",
|
||||
"Design Engineering": "design-engineering",
|
||||
"Coding": "coding",
|
||||
|
Loading…
Reference in New Issue
Block a user