Thứ Hai, 10 tháng 12, 2018

DIY Joystick Controlled Mobile Robot- Tự làm robot điều khiển tay cầm

Introduction

Mobile Robots have the capability of moving from one place to another, just like us. We can move from one place to another using our senses, thinking, and muscles. But yes! we are very complex and making a robot like us will take a lot of knowledge and efforts. What we will be learning here will give you a very good feel for robotics.
In this project, we will first go through basic concepts for designing and making a robotic car, then we will move forward and make a simple robot which will go forward, backward, right and left. The robot will be controlled with a Joystick, which consists of two potentiometers. Through these potentiometers, you can get the X and Y movement, which will be used to navigate the robot. But first, let us assemble the robot.
Given below is the final assembly of the robot.Joystick Controlled robot

Components Required

IMAGECOMPONENTQUANTITYAVAILABLE IN KIT
evive1
Acrylic Part: Base Plate1
Dual Shaft BO Motor2
BO Motor Mount2
M3 bolts of 8 mm Length7
M3 bolts of 25mm Length4
M3 bolts of 12mm Length5
M3 Nuts8
BO Wheel2
Caster Wheel1
XY-axis Joystick Module1

Building Guide

Step 1: Basic Concepts of Mobile Robot

Wheels

Just like real cars, a robotic car also has wheels which are actuated using motors. For a moving object to be stable, you need at least 3 contact points with the surface on which it is moving. For e.g. in a car, you have four wheels, but on a bicycle, there are only two wheels. A cyclist can control the bicycle only when he is cycling, but if he stops he can’t balance the cycle without resting one of his foot on the ground. 
In our mobile robot, we will have 2 wheels and one caster wheel touching the ground. A caster wheel has a small round sphere, which rolls on the ground. It is passive and can move in any direction.

Differential Drive

A differential wheeled robot is a mobile robot whose movement is based on two separately driven wheels placed on either side of the robot body. Thus, it can change its direction by varying the relative speed of its wheels and hence does not require an additional steering motion.
If both the wheels are driven in the same direction and speed, the robot will go in a straight line. If both wheels are rotated with equal speeds in opposite directions with respect to each other, the robot will rotate. Otherwise, depending on the speed of rotation and its direction, the center of rotation may fall anywhere on the line defined by the two contact points of the tires. While the robot is traveling in a straight line, the center of rotation is an infinite distance from the robot.
Pure Translation Motion Mobile RobotPure Rotational Motion Mobile Robot
Our robot has a configuration similar to that of a three-wheeled differential drive robot.

Chassis

Chassis is the base frame of any robot, on which driving motors and caster wheels are mounted.

Step 2: Assembly of Robot

The annotated base is shown on right. This is the bottom side. There is an evive logo on the top side for your reference. So be careful while using the base.chassis_base
  • Fix the motor mounting brackets to the chassis using M3 bolts of 8mm length and M3 nuts.motor mounting brackets
evive Alert
The motor wires should be inside, otherwise, they will collide with the wheel. Also, while assembling the robot, be careful about the holes you are using. Also, fasten all the nuts and bolts tightly for smooth functionality.
  • Attach the two motors, one to each bracket, side by side and fasten using M3 bolts of 25mm length and M3 nuts.attaching_motor
  • Now, fit the wheels into the protruding motor shafts.attaching_wheels
  • We’ll attach the Castor wheel now. First, we will mount the M3 standoffs (20 mm) on which the Castor will be attached. Fasten the standoffs to the chassis using M3 bolts of 8mm length.
  • Place the Castor on top of the standoffs in the configuration shown and fasten using M3 bolts of 12 mm length.attaching_castor
evive Notes Icon
Keep in mind, that what we have assembled so far (motors and castor) will be pointing downwards.
  • Flip the assembly and place evive on the top of the chassis.placing_evive
  • Using the holes on the back of evive fasten it to the chassis using M3 bolts of 12mm length.Fastening evive
evive Notes Icon
Your basic mobile robot is now ready. This is the framework for almost every robot that we’ll work with. Modify it according to your need to use it as a line following, obstacle avoiding, light-tracking robot etc.

Step 3: Circuitry of the Robot

The circuit diagram of the mobile robot is very simple, you just have to attach left motor on motor channel 1 (marked as M1 ) and right motor to channel 2 (marked as M2 ).
Next is the joystick. A Joystick can move along two directions, namely X and Y axes. It has two potentiometers to sense motion, which gives analog signal. It also has a switch which gets ON when user center press on the joystick. Given below is the Joystick circuit.
  1. Black Wire: Connected to Ground (GND)
  2. Red Wire: Connected to 5V (VCC)
  3. Green Wire: X-axis potentiometer output (VRx)
  4. Orange Wire: Y-axis potentiometer output (VRy)
  5. No Wire: Switch output (SW)
MobileRobotJoystick_bb

Step 4: Logic

After assembling the robot and wiring, we will now discuss the logic that should be used to program the robot.
Every program has a very basic structure consisting of two parts. First is initialisation, which is executed only once and the second is the loop, in which a set of blocks runs repetitively. Given below is the logic diagram for our robot, where the blue block is the initialization and all other blocks go in loop, which is executed repetitively.
JoystickLogic
Let the analog value we get from the Joystick in x-axis be Vx and from the y-axis be Vy. We will program the robot to work in digital mode, in which the motors will have only three states. They will be either rotating clockwise or anticlockwise or will be free. For these cases, we will set up 2 threshold value on analog value. As you know the analog reading varies from 0 for 0V and gradually increased to 1023 for 5V. The default (mean) state value is around 512 (≈1023/2). We will set threshold at 400 and 600, meaning if the value is less than 400, robot will go in one direction, while if the value is greater than 600, it will move in opposite direction and if the value is between 400 to 600, nothing will happen. We have created the flow chart for this logic.
MobileRobotJoystick
There are five actions that the robot can take:
  1. Go Forward
  2. Go Backward
  3. Turn Right
  4. Turn Left
  5. Brake

Step 5: A quick recap of Scratch

Scratch is a visual programming language that helps kids and budding programmers, to learn how to code, i.e. how to write a program in a fun, educational, and easy way using pieces known as blocks. This makes learning coding nothing but a jigsaw game that helps develop problem-solving and decomposition skills.
We will be using mBlock, a software based on Scratch for making our game. If you don’t have mBlock installed in your laptop/PC, visit here for detailed instructions on how to install it.
There are four basic elements for programming in mBlock:
  1. Stage
  2. Sprites
  3. Script
  4. Blocks
There are two modes in Scratch using which you can work:
  1. Scratch Mode
  2. Arduino Mode

Scratch Mode

In Scratch mode, which is the default mode in mBlock, you can run the script and control evive as long as it is connected to your laptop/PC; the moment you remove the USB you cannot use the script to work with evive anymore.

Arduino Mode

In Arduino mode, the blocks are transferred to Arduino C++ in Arduino IDE, and then you can modify the code in Arduino IDE. Another important aspect of Arduino mode is that you can upload the code to evive using this mode only.
To know more, please visit here.
We are going to program this robot in Scratch Mode.

Step 6: Scratch Script

Now we are going to create Scratch scripts to generate code for our robot.
evive Notes Icon
We will be using Arduino, evive TFT Display and evive inbuilt functions extension from Robot palette. So, make sure you have added these extensions in mBlock.
  1. We want to upload the script into evive, hence we will work in Arduino Mode. Drag-drop evive Program hat block into the scripting area.
  2. We will be breaking the whole script into smaller scripts, which can be used along with the main script. We do it by creating custom blocks. Go to the Data&Blocks palette, and select Make a Block. Name it Initialisation.make a blockmaking a custom block
  3. In the Initialisation block, we set the TFT background and lock both motors.InitilisationBlock_JoystickControlledRobot
  4. Snap the Initialisation block below the evive Program block.
  5. We will make two variables to store Vx & Vy. Go to Data&Blocks palette and select Make a Variable. Name them as Vxand Vy.make a variable
  6. The remaining code will repeat forever.
  7. Inside the forever, block snap the set variable to block from Data&Blocks palette. Vx will store the analog value from analog pin A0. Similarly, repeat this for Vy. Add a little delay of 0.1 secs at the end of the forever loop.
  8. We will now test our code. Connect evive to your Laptop using the USB cable. Go to Connect and select the appropriate COM port.
  9. On the toolbar, click on Edit and select Arduino Mode. Click on Upload to Arduino.After the code has been uploaded, you can observe the value Vx & Vy on evive’s display.
  10. Now, we have to assign the actions according to the value of Vx & Vy.
  11. Create a new block named GoStraight. We have to move both motors in the same direction at same speed.
    GoStraight
  12. Similarly create blocks GoBackwardTurnRight and TurnLeft for moving the robot backward, right and left respectively. While turning the motors will rotate in opposite direction.GoBackwardTurnLeft
     
    evive Tips and Tricks
    For debugging purposes, turn ON the Pin 13 LED.
     
  13. We will also make a block for stopping the robot, named Brake.
    Brake
  14. Create another block named PrintValue. Copy the script in step 7; remove the evive Program block & forever block from that script.PrintValue
  15. Coming to the main code using the ifelse block in the control palette and the flowchart makes the complete script.JoystickControlledRobot
  16. After completing the main script, upload it to evive from Arduino Mode and run the robot.

Step 7: Debugging the Robot

At times, your robot will refuse to behave the way you are commanding it to. Let’s fix this. If upon pressing forward, your robot starts moving backward or starts turning, that means at least one motor is rotating in the wrong direction. You can fix this by reversing the direction of that motor.
Exchanging Wiring
Your forward-backward controls shall now work perfectly. If the robot turns left upon pressing left and right upon pressing right, your robot is good to go. If it turns right upon pressing left, you can fix this by exchanging wires of both the motors. Ask an elder for help, if you need.
Exchanging Motor Wiring

Step 8: Explore Starter Kit Courses

A series of exciting online courses through the world of STEM that cover not only the ‘whys’ but also the ‘hows’. They introduce you to the wonders of electronics, programming, science, latest technologies such as robotics, Internet of Things, 3D printing, and many more!
Introduction to Electronics
ELECTRONICS
Introduction to Programming
PROGRAMMING
robotics img
ROBOTICS

Circuit Diagram

DESCRIPTIONCIRCUIT DIAGRAM
Attaching motors and joystick to evive.

Code

DESCRIPTIONDOWNLOAD CODE
Scrtach Code for Joystick Controlled RobotDownload

Không có nhận xét nào:

Đăng nhận xét

Bài đăng mới nhất

ALEPH-M CLASS A ANFİ DEVRESİ N KANAL MOSFET

Aleph-M çıkış gücü yaplaşık olarak 35w Class A sınıfı anfi için oldukca iyi bir değer çıkış modfetleri n kanal 2 adet irfp240 kullanılmış be...

Bài đăng phổ biến