Beruflich Dokumente
Kultur Dokumente
LITERATURE REVIEW
β
L2
L1
y
Consider a robot arm made out of two links and two joints that is mounted to a
table. Let the length of the first link be l1 and the length of the second link is l2. To
specify the position of the link closer to the table by the angle α and the angle of the
second link relative to the first link using the angle β. Suitable conventions and
coordinate systems are shown in Figure 2.1.
To calculate the position of the joint between the first and the second link
using simple trigonometry are used equation (2.1) and (2.2) [15Ran].
𝑥1 = cos 𝛼 𝑙1 (2.1)
𝑦1 = sin 𝛼 𝑙1 (2.2)
Similarly, the position of the end-effector is given by equation (2.3) and (2.4).
𝑥2 = cos(𝛼 + 𝛽)𝑙2 + 𝑥1 (2.3)
𝑦2 = sin(𝛼 + 𝛽) 𝑙2 + 𝑥1 (2.4)
Figure 2.2. Pitch, Yaw and Roll-around the Principal Axis of an Air-plane[15Shri]
For manipulating arms, degrees of freedom usually refer to the positions and
orientations, i.e., rotations around the primary axis, the end-effector can reach. As a
rule of thumb, each joint usually adds a degree of freedom unless they are redundant,
that is, moving in the same direction.
Figure 2.4. Manipulators with One, Two, Three and Three DOF (From Left to Right)
8
9V
0V
10% 50% 90%
Figure 2.5. Example of Pulse Width Modulation
2.5.2. Microcontrollers
A microcontroller is a small computer on a single integrated circuit containing
a processor core, memory, and programmable input/output peripherals. Program
memory in the form of Ferrolelectric RAM, NOR flash or OTP ROM is also often
included on chip, as well as a typically small amount of RAM. Microcontrollers are
10
The board can operate on and external supply from 6 to 20 volts. If supplied with less
than 7V, however, the 5V pin may supply less than five volts and the board may
become unstable. If using more than 12v, the voltage regulator may overheat and
damage the board. The recommended range is 7 to 12 volts. Technical specifications
of Arduino UNO board are the following. The design of the Arduino UNO board is
shown in Figure 2.7.
Operating Voltage 5V
Input Voltage (recommended) 7-12V
Input Voltage (limit) 6-20V
Digital I/O Pins 14 (of which 6 provide PWM output)
PWM Digital I/O Pins 6
Analog Input Pins 6
DC Current per I/O Pin 20mA
DC Current for 3.3V Pin 50mA
Flash Memory 32 KB (ATmega328P)of which .5KB
used by bootloader
SRAM 2KB (Atmega328P)
EEPROM 1KB (Atmega328P)
Clock Speed 16 MHz
Length 68.6 mm
Width 53.4 mm
Weight 25 g
Operating Voltage 5V
SRAM 8 KB
EEPROM 4 KB
LED_BUILTIN 13
Length 101.52 mm
Width 53.3 mm
13
Responsible TWI(I2C)
Serial
USB PWM Output Communication
Communication
USB
Connector
Source
7 to 12V
Analog Inputs Rest button
Regulator 3.3 V Power pins
SPI write operation is shown in Figure 2.10. There are FIFOs for both TX and
RX modes (as mentioned in the “SPI Instruction Set” section). FIFO means “first in /
first out “. Both of the FIFOs are three levels deep, meaning that they will hold the
three newest packets that have been put into them.
Worldwide 2.4GHz ISM band operation
Up to 2Mbps on air data rate
Ultra low power operation
11.3mA TX at 0dBm output power and 12.3mA RX at 2Mbps air data rate
900nA in power down and 22µA in standby-I
On chip voltage regulator
1.9 to 3.6V supply range
Enhanced ShockBurst™
Automatic packet handling and Auto packet transaction handling
6 data pipe MultiCeiver™
Air compatible with nRF2401A, 02, E1 and E2
Low cost BOM • ±60ppm 16MHz crystal
5V tolerant inputs
Compact 20-pin 4x4mm QFN package
15
The main reason of using NRF 24L01 wireless transceiver module is that it
allows 126 channels (MAX). Our bomb disposal robot needs 8 channels for
transmission and receiving. This thesis uses 8 pipes from NRF24L01 because 1 pipe
operates 1 transmitting and receiving path.
The shunt-wound motor: In this case the field is in parallel with the armature,
as shown in Figure 2.13, and the shunt motor is the standard type of dc motor for
ordinary purposes. Its speed is nearly constant, falling off as the load increases due to
resistance drop and armature reaction.
Figure 2.18. MG995 High Torque Metal Gear Dual Ball Bearing Servo[15Farz]
Figure 2.19. MG996 High Torque Metal Gear Dual Ball Baring Servo[15Farz]
Pin out design of the servo motor is shown in Figure 2.20. There has three
pins: Pulse Width Modulation pin (PWM), power supply pin (VCC) and ground pin
(GROUND). PWM is assigned as orange color, power pin is red color and ground pin
is brown color.
PIN 1= INPUT
PIN 2=
PIN 1= INPUT
GROUND
PIN 2= GROUND
PIN 3= OUTPUT
PIN 3= OUTPUT
1
1
2 32 3
LM 323
INPUT OUTPUT
Cin Cout
0.33uF 100uF
A common ground is required between the input and the output voltages. The
input voltage must remain typically 2.5 V above the output voltage even during the
low point on the input ripple voltage. Simple connection of 5V regulator LM323 is
shown in Figure 2.24.
Cin is required if regulator is located an appreciable distance from power
supply filter.
Cout is not needed for stability; however, it does improve transient response.
Robotic arm of bomb disposal robot use LM323 with additional transistor TIP
41 because LM323 output current is not sufficient for servo MG995 and MG996
(Specification of Servos). The internal configuration of LM323 IC is shown in Figure
2.25.
2.9. Summary
This chapter describes devices and components used in bomb disposal robot.
The features and opeation of each device are discussed in detail. Atmega 2560
microcontroller is the heart of the system. Design of the robotic arm is also important
in this work. So, how to design and device is described in detail. The next chapter will
present the design and circuit for bomb disposal robot.