Professional Documents
Culture Documents
4992 Final Report 0951
4992 Final Report 0951
4992 Final Report 0951
BAHÇEŞEHİR UNIVERSITY
Project 0951
Stair Climbing Robot
Advisors:
Assist. Prof. Andrew John Beddall
Assoc. Prof. Armağan Fatih Karamanlı
i
STUDENT DECLARATION
By submitting this report, as partial fulfillment of the requirements of the Capstone course, the
students promise on penalty of failure of the course that
they have given credit to and declared (by citation), any work that is not their own
(e.g. parts of the report that is copied/pasted from the Internet, design or
construction performed by another person, etc.);
they have not received unpermitted aid for the project design, construction, report or
presentation;
they have not falsely assigned credit for work to another student in the group, and not
take credit for work done by another student in the group.
ii
ABSTRACT
PROJECT 0951
STAIR CLIMBING ROBOT
Advisor:
Assist. Prof. Andrew John Beddall
Assoc. Prof. Armağan Fatih Karamanlı
June 2020
This report is about an autonomous stair climbing robot built by 2 Electrical and
Electronics Engineering students and 2 Mechatronics Engineering students. The designs and
coding are created by this 2 teams mentioned above. Be advised due to Covid-19 pandemic
occurred in Spring Semester of 2020, robot is not finished entirely as planed. However, all
the physical structure, sensor arrays and coding tested and results are collected. The
robot theoretically should climb any stairs autonomously as shown in the report. The
physical structure and electrical systems are not interated physically.
ABSTRACT ..............................................................................................................................iii
TABLE OF CONTENTS .......................................................................................................... iv
LIST OF TABLES .................................................................................................................... vi
LIST OF FIGURES................................................................................................................... vi
LIST OF ABBREVIATIONS .................................................................................................. vii
1. OVERVIEW........................................................................................................................... 1
1.1. Identification of the need............................................................................................ 1
1.2. Definition of the problem ........................................................................................... 1
1.3. Standards and constraints ........................................................................................... 1
1.4. Conceptual solutions .................................................................................................. 2
1.5. Physical architecture................................................................................................... 4
2. WORK PLAN ........................................................................................................................ 5
2.1. Work Breakdown Structure (WBS) ........................................................................... 5
2.2 Responsibility Matrix (RM) ........................................................................................ 5
2.3. Project Network (PN)................................................................................................. 6
2.4. Gantt Chart ................................................................................................................. 6
3. DESIGN PROCESS ............................................................................................................... 7
3.4. Electrical and Electronics Engineering ...................................................................... 7
3.4.1. Definition of the problem.................................................................................. 7
3.4.2. Review of technologies and methods................................................................ 7
3.4.3. Standards and constraints .................................................................................. 9
3.4.4. Conceptualization.............................................................................................. 9
3.4.5. Physical architecture........................................................................................ 10
3.4.6. Risk assessment............................................................................................... 10
3.4.7. Materialization ............................................................................................. 11
3.4.8. Evaluation........................................................................................................ 12
3.8. Mechatronics Engineering........................................................................................ 13
3.8.1. Definition of the problem ................................................................................ 13
3.8.2. Review of technologies and methods.............................................................. 14
3.8.3. Standards and constraints ................................................................................ 14
3.8.4. Conceptualization............................................................................................ 15
3.8.5. Physical architecture........................................................................................ 16
iv
3.8.6. Risk assessment............................................................................................... 32
3.8.7. Materialization ................................................................................................ 33
3.8.8. Evaluation........................................................................................................ 33
4. RESULTS............................................................................................................................. 33
5. CONCLUSION .................................................................................................................... 34
ACKNOWLEDGEMENT ....................................................................................................... 35
REFERENCES......................................................................................................................... 36
APPENDIX A .......................................................................................................................... 37
APPENDIX B .......................................................................................................................... 42
5
LIST OF TABLES
LIST OF FIGURES
vi
LIST OF ABBREVIATIONS
M2M Machine-to-Machine
3D Three Dimensional
DC Direct Current
TL Turkish Lira
CE Conformite Europeenne
vii
1. OVERVIEW
This report is about an autonomous stair climbing robot, that built by 4 engineering
students including 2 electrical and electronics students and 2 mechatronics students.
Mehmet Akif Ekrekli and Veysel Bitgül on the mechatronics team and Kaan Han Elmalı
and Sinan Oğuzhan Başkurt on the electrical and electronics team.
This product is designed for those who want to reach inaccessible places. The main
objective for this product is to climb any kind of stairs to reach to the top by itself, but it can
be modified easly to be an all terrain robot.
The main task for team to design and costruct a robot that will autonomously climb
the top 19 steps of the Law Faculty staircase (D building). Also it can be able to climb any
kind of stairs autonomously.
This robot comply with all the standards to IEEE, CE, IEC and ISO because it’s made
by all original electrical, electronic and electromagnetic devices. Cabling made safely to not to
create a dangerous situation to users. The power supply that provides power to the system and
the motors is 12 Volts DC and it’s below dangerous limit (50 Volts). The two major
constraints are;
1
Remote control is not allowed by any means (wifi, radio signals etc.); the vehicle must
be autonomous with all sensors, controls and computation located on the vehicle.
During design process, we have created multiple conceptual designs. Some of the
significant ones and influential ones for our last desing are;
I. Legged Based Robot;
This design idea was inspired by Boston Dynamics’ SPOT design. See also Reference
[1]. We didn’t choose this design because of it would be very hard to operate and sustain
within the economical limits we have.
This design idea was inspired by NASA’s Mars Rovers. See also Reference [2]. This
design idea was the most influential one on the final version of design. The reason for that
is Mars Rovers are designed to overcome any terrains that they face, and it’s similar to
this project’s goal, climbing any stairs.
2
III. Track Based Robot;
This design was also influential on the final design. Tracks are used widespreadly on offroad
vehicles due to it’s high friction levels.
3
1.5. Physical architecture
On final design we blended track based model and 6 wheel model to create the optimum design
for our problem. For the electrical side we choose the Arduino MEGA with ultrasonic sensors
and gyroscopes to navigate the robot through stairs.
4
2. WORK PLAN
1.1 Teams
1.1.2. Electrical
1.1.2.1.Order/Manufacture Parts
1.1.2.2.Assemble
1.1.2.3.Test
1.1.3. Mechanical
1.1.3.1.Order/Manufacture Parts
1.1.3.2.Assemble
1.1.3.3.Test
5
2.3. Project Network (PN)
Week 1 2 3 4 5 6 7 8 9 10 11 12 13 14 15
Akif 1 1.2.3
1.2 1.2.1 1.2.4 1.3 3.1
Veysel 1 .1 1.2 .2
0/3.3
Sinan 2.2.1.2
2/2.1 2.1.2 2.2 2.2.1 2.2.2 3.2
Kaan 2.2.1.1
6
3. DESIGN PROCESS
This stair climing robot aims to climb any stairs, fully autonomously, without any
remote control or help. By the nature of its design, it can be used as an all terrain
vehicle/robot aswell. This features also provides great flexibility on robot’s usage areas; for
example its can be helpful for disabled people or elders to climb stairs on the other side it
can help law forces to access dangerous areas, buildings, places. This robot can adapt to
new enviroments and conditions very easily.
This robot is designed very efficient due to economical boundaries. It uses ultrasonic
sensor array that we designed instead of image processing because camera would cost much
more and it would require more powerful processor to do the not same but similar work. On
the front side of the robot, there are 4 ultrasonic sensors measuring real time distance
values to detect the steps of the stairs. It requires upper 2 sensors to be same values, lower 2
sensors to be same values and at the same time lower 2 and upper 2 sensors’ values’
difference should be exact to the steps’ width. Robot also consists of a gyroscopic sensor to
sense the slope. 12 Volts 7Ah DC power supply used in this project. Which is enough for
the robot if we consider, a motor will draw 530mAmps in maximum load conditions. 4 𝑥
530𝑚𝐴 = 2120𝑚𝐴𝑚𝑝𝑠 and
7000𝑚𝐴ℎ ÷ 2120𝑚𝐴 = 3.30 ℎ𝑜𝑢𝑟𝑠 of energy will be supplied in maximum load
conditions of motors. (Sensors’ and microcontroller’s enegy consumption is neglected
because of very low values.)
7
Figure 7 Sensor Array Testing Prototype
8
3.4.3. Standards and constraints
This robot comply with all the standards to IEEE, CE, IEC and ISO because it’s made
by all original electrical, electronic and electromagnetic devices. Cabling made safely to not
to create a dangerous situation to users. The power supply that provides power to the system
and the motors is 12 Volts DC and it’s below dangerous limit (50 Volts).
3.4.4. Conceptualization
Electric and electronic engineering students of this project chose the 2. option due to
economical boundries and being familiar with the sensors. 4 motors has chosen because of the
mechanical design. Motor’s specifications are; 50 RPM 530 mA strain current and 1.21 N/m.
12 Volts 7 Ampere.hour DC power supply has chosen because of the requirements of the
4 motors.
9
3.4.5. Physical architecture
Robot contains 7 ultrasonic sensors; 4 on the front, 1 on left, 1 on right and 1 on the
back. A gyroscope placed on top of the robot and Arduino on top aswell. 4, 12 Volts redactor
motors has placed; 2 on tracks and 2 on back wheels. The detection of stairs system works
thanks to 4 ultrasonic sensors placed in front of the robot accompanied by a gyroscope and
the Arduino MEGA.
10
3.4.6.4. Mistakes at testing
Mistakes at testing can be very dangerous because it can cause irreversible damages to
the robot itself. If robot falls down during testing it can broke the system and itself, and we
couldn’t be able to determine the mistake aswell. And on the other hand one mistake that we
overlooked on testing can emerge at the presentation. This difficulties overcame by creating a
safe environment to test and test as much as possible.
3.4.7. Materialization
The physical structure of sensor array has not been changed since 4991 course and it’s
built as planned. The framework that is 3D printed has some aesthetical flaws due to 3D
printer itself but it fulfils the tasks. The results are;
11
The first thing that electrical and electronics team started to work on the code is to
calibrate the distance sensors, get values from them and to code the microcontroller to
perceive the stairs. Then team worked on program the microcontroller to make it capable
of making decisions. After all of the main structure of coding is finished, team worked on
making it more optimized and efficient.
3.4.8. Evaluation
The final version of the array on work can be seen in this video with details. Please
check the description of the video aswell; https://www.youtube.com/watch?
v=yyYww8ND5vU
12
3.8. Mechatronics Engineering
There are some challenging stair climbing robots. However almost all of them have risks
on at least one part of working algorithm. For instance, tank track-based robots are having
a great risk of turn over. If the motor calculations are not done perfectly, torque might be
too much for that robots’ weight and it could turn over. For legged based robots, stairs
surface is vital. Depending on the material that is assembled on the robot`s touching point to
the ground, robot can slip and fall over.
13
3.8.2. Review of technologies and methods
This robot complies with all the standards to IEEE, CE, ASTM, IEC and ISO because
it’s made by all original electrical, electronic and electromagnetic devices. Cabling made
safely to not to create a dangerous situation to users. The power supply that provides power
to the system and the motors is 12 Volts DC and its below dangerous limit (50 Volts).
Constrains:
No jumping or flying.
No remote control; the vehicle must be autonomous with all sensors, controls and
computation located on the vehicle.
The robot must not be assisted in any way by a human once it starts it's climbing task
from the floor below the first step.
The robot must carry its own energy source.
The robot must start at the bottom of the stairs, not touching the first step
14
A robot will be designed and constructed to autonomously climb the top 19 steps of the
Law Faculty staircase (D building).
3.8.4. Conceptualization
Model of Ours
In these models, robot is carried by wheels or tank tracks. Instead of acting like a living
creature, it moves as a vehicle. In addition, calculations are quite different than legged
based
15
robot. Figures 2 and 3 are alternative concept designs.
We designed the robot to prevent those risks. With combining wheel and tank-track
systems the robot will not turn over or slide on the ground and fall.
Physical Structure
There are 3 vital aspects of this part; Weight, Strength, Economy. Our robot
(hereinafter called Necati) must be as light as possible in order to stay in our targeted budget.
Heavier the robot gets, much more expensive motors we will need. Product selection is
another significant point as well. Necati is divided into 2 main subsystems and selected it`s
materials in order to achieve the best weight strength economy ratio.
1. Pipe Framework
PVC pipes are selected to connect entire robot together. The main reason of this choice is that
PVC pipes are light and have the durability we need. Also, it is cheap and could be gathered
easily.
16
Figure 15 Upper Body Exploded View
17
Figure 16 Lower Body Exploded View
3. Supporting Components
Apart from these subsystems there are also supporting equipment such as connections,
rear wheels etc.
A connection is designed for the upper zone connection so that the TTB can move
18
easily. This common design was printed with a 3D printer and added to the system.
The joint contains 2 parts and these parts relate to the help of a shaft and a nut. In this
way, the Sub Joint can move comfortably within the upper joint.
Motors (Reference [8])
DC Motors are placed into rear supporting wheels and rear TTB (Tank Truck Base) wheels.
In this placement, rear TTB wheels are main carrier of the system. Rear supporting motors
will help climbing and prevent possible sliding backwards.
To select an optimum DC Motor, a torque calculation is needed. After finding the required
torque, DC Motor could be found on the market. Relevant amps and power values are
discussed with electronics team in order to help them select the battery.
Robot contains 7 ultrasonic sensors; 4 on the front, 1 on left, 1 on right and 1 on the back. A
gyroscope placed on top of the robot and Arduino on top as well. 4 12 Volts redactor motors
have placed; 2 on tracks and 2 on back wheels.
Our Motor's Properties:
Brand: ZHENGK
Power: 7.5W
Weight: 230gr
19
20
Basic Theoretical Calculations
-Variables-
Fk = Traction generated by the motor.
Nk = Ground reaction force
fi = friction forces at i-th step
Ni = Supportive force at i-th step
Equations
1-) Energy Equation
1 2𝜋𝑟 1
2 𝑚=𝑚𝑣
𝑚𝑜𝑡𝑜𝑟 () 2
𝑔𝑒𝑎𝑟 𝑔𝑒𝑎𝑟
60 2
𝑔𝑒𝑎𝑟 = 𝑔𝑒𝑎𝑟 𝑔𝑒𝑎𝑟
1 22222 1 1 1 1
[22222
𝑚1 𝑔𝑒𝑎𝑟1 + 12 ]
𝑒𝑎𝑟1 + [ 𝑚2 𝑔𝑒𝑎𝑟2 + 𝑒𝑎𝑟2 ] = [ 𝑚𝑝𝑎𝑙𝑒𝑡 𝑣𝑝𝑎𝑙𝑒𝑡 ]
𝐹 − 𝑁 sin(46.6) + 𝑓 cos(46.6) = 𝑚𝑥
−𝑚𝑔 + 𝑁 cos(46.6) + 𝑓 sin(46.6) = 𝑚𝑦
−𝑚𝑔𝑝𝑐𝑜(𝜑 + 𝛽) + 𝑁[𝐿𝑐𝑜𝑠(46.6 − 𝛽) + (𝑖ℎ − 𝐿𝑠𝑖𝑛(𝛽)] + 𝑓 sin(46.6 − 𝛽) − 𝑚𝑥𝐺 (𝑦𝐺 + 𝑅)
− 𝑚𝑦𝐺 𝑥𝐺 = 𝐽 𝛽
Robot Stability
1-)𝐸0 = 𝑚𝑔(𝑦 ′ 𝐺 − 𝑦𝐺 ) = 𝑚𝑔(√ℎ2 + 𝑏 2 −
𝜋ℎ
𝑦𝐺 ) 𝛿 = − arctan ( ) − arctan𝐺 ( )
2 𝑏 𝐺 𝑥 −𝑆
Value of lowest torque could be obtained on the stand still case of robot on the sloppy stairs.
Total torque must be qual to weight`s torque to keep the robot stationary on the stair.
To build a basic torque calculation we took our reference surface as hypotenuse of stairs.
Here is the simplified version of image;
Since there will be only one type of motor for every wheel and gear, we just need to calculate
total weight`s torque and divide it by 4. (Total weight is considered as 10kg.)
𝐺 ∗ 0.124 = 𝑇𝑚𝑜𝑡𝑜𝑟𝑠
12.16 = 𝑇𝑚𝑜𝑡𝑜𝑟𝑠
12.16
𝑇𝑚𝑜𝑡𝑜𝑟 = 4 = 3.04𝑁
22
Mechanical Properties
Aluminium 6061 (Profile) (Refence [3])
Chemical Composition:
Fe Si Cr Mn Mg Zn Cu Ti Others Al
0.5 0.6-1.0 0.1 0.2-0.8 0.8-1.2 0.25 0.6-1.1 0.1 0.15 Rest
Physical Properties:
Properties Values
Properties Values
Characteristics:
- High hardness, good curability
- High corrosion resistance
- Good welding can be done.
23
PVC Conveyor Belt (Reference [5])
Mechanical Properties:
PVC (plasticised):
Properties Values
Density (g/cc) 1.3 – 1.45
Hardness 80
24
PVC(plactised) which has lower inelasticity than PVC-U is easier at applications of moulding
and extruding. PVC`s is quite low compared to PVC-U in terms of temperature resistance and
resistivity to chemicals.
25
PVC-U(unplasticised) ,which has great tensile stress of roughly 52 MPa at 293K, is hard and
inelastic and it has resistivity to chemicals. Normally, PVC-U could be used up to 333K, however
the real temperature is conditional on applied stress and environment .
26
Carbon/Epoxy Composite Rod (Wheel): (Reference [6])
Property Value
Compressive Strength - Longitudinal 800 - 1300 MPa
27
PLA (Polylactic Acid) (For 3d printed connecting parts) (Reference [7])
Note:
1 PSI = 0,00689475728 MPa
28
29
Material Budget
30
Control Algorithm:
Our distance sensors are fully connected to microcontroller. They are taking power and
sending signals to microcontroller directly. Our battery is supplying power to microprocessors and
motors via motor drivers. Also, microcontroller sends signals to drivers to control the motors.
Interface Design:
31
3.8.6. Risk assessment
32
3.8.7. Materialization
3.8.8. Evaluation
The robot, where we have made theoretical research, calculation and technical
drawings, has not come to a conclusion due to test requirements and not being built.
4. RESULTS
Due to Covid-19 pandemic the project didn’t finished as planned. The teams are worked
separately and created their own products. For the electrical and electronics engineering team
the final results can be seen at this video;
https://www.youtube.com/watch?v=yyYww8ND5vU
For the mechatronics engineering side, technical drawing can be found at Appendix B.
Table 4 Costs
33
5. CONCLUSION
Due to Covid-19 pandemic, the teams couldn’t finish this project as planned before at
Capstone Project 4991 course. But for this reason, this project can’t be specified directly as a
failure.
Teams tried to adapt the project into to the situation and created systems for required
objectives that discussed and determined with their advisors before. The electrical
and electronics team has built and tested the designed sensor array and developed the coding
for the robot. For the mechatronics side, the team has developed 3D modelling.
In the future, if the suitable environment and time occurs, teams would like to integrate
the systems into final product and test the project as a whole, and develop it if any faults
occur.
Meanwhile working on this project, the major things that the teams are learnt from this
project are how to work remote and far away from each other, and how to deal with
extraordinary situations, as the world is going through in 2020. Other than that teams learnt
how to work as a team. The team members didn't stay as a team for so long before. Also the
team gained experience on programing language C, SolidWorks CAD, and on project
management.
34
ACKNOWLEDGEMENT
We wish to thank our advisers Assist. Prof. Andrew John Beddall and Assoc. Prof.
Armağan Fatih Karamanlı. Also thanks to the Kılavuz Konveyör for the tank track belts
fabricated for us.
35
REFERENCES
36
APPENDIX A
Adafruit_MPU6050 mpu;
//Variables
void setup(void) {
Serial.begin(115200); // To start serial consol at 115200 bit rate
while (!Serial)
delay(10); // Will pause until serial console opens
//Initializng the Motor Pins
pinMode(enA, OUTPUT);
pinMode(in1, OUTPUT);
pinMode(in2, OUTPUT);
pinMode(in3, OUTPUT);
37
pinMode(in4, OUTPUT);
pinMode(enB, OUTPUT);
// Try to initialize!
if (!mpu.begin()) {
Serial.println("Failed to find MPU6050 chip");
while (1) {
delay(10);
}
}
Serial.println("MPU6050 Found!");
//Calibration
mpu.setAccelerometerRange(MPU6050_RANGE_8_G);
Serial.print("Accelerometer range set to: ");
switch (mpu.getAccelerometerRange()) {
case MPU6050_RANGE_2_G:
Serial.println("+-2G");
break;
case MPU6050_RANGE_4_G:
Serial.println("+-4G");
break;
case MPU6050_RANGE_8_G:
Serial.println("+-8G");
break;
case MPU6050_RANGE_16_G:
Serial.println("+-16G");
break;
}
mpu.setFilterBandwidth(MPU6050_BAND_21_HZ);
Serial.print("Filter bandwidth set to: ");
switch (mpu.getFilterBandwidth()) {
case MPU6050_BAND_260_HZ:
Serial.println("260 Hz");
break;
case MPU6050_BAND_184_HZ:
Serial.println("184 Hz");
break;
case MPU6050_BAND_94_HZ:
Serial.println("94 Hz");
break;
case MPU6050_BAND_44_HZ:
Serial.println("44 Hz");
break;
case MPU6050_BAND_21_HZ:
Serial.println("21 Hz");
break;
case MPU6050_BAND_10_HZ:
38
Serial.println("10 Hz");
break;
case MPU6050_BAND_5_HZ:
Serial.println("5 Hz");
break;
}
Serial.println("");
delay(100);
}
void loop() {
//SMOOTHING PART (cycles 25 times, adds them to each other to take average)
for (int cycle = 0; cycle < 25; cycle++) {
sensors_event_t a, g, temp;
mpu.getEvent(&a, &g, &temp);
//Calculating the angle of acceleration
float accxy = (a.acceleration.z * a.acceleration.z) + (a.acceleration.y *
a.acceleration.y);
float denominator = sqrt (accxy);
float angle = atan2(a.acceleration.x, denominator); //angle is in terms of
radian
float degree = angle * 180 / 3.14159265; //converting radian to degree
//Serial.println(degree);
}
avgacc = oldacc / 25;
newacc = 0;
Serial.println("");
delay(10);
39
}
// Detecion function
void detection() {
// Set motors to 55
// For PWM maximum possible values are 0 to 255
digitalWrite(in1, HIGH);
digitalWrite(in2, LOW);
digitalWrite(in3, LOW);
digitalWrite(in4, HIGH);
digitalWrite(trigPin1, LOW);
delayMicroseconds(5);
digitalWrite(trigPin1, HIGH);
delayMicroseconds(10);
digitalWrite(trigPin1, LOW);
pinMode(echoPin1, INPUT);
duration1 = pulseIn(echoPin1, HIGH);
cm1 = (duration1 / 2) / 29.1; // Divide by 29.1 or multiply by 0.0343
inches1 = (duration1 / 2) / 74; // Divide by 74 or multiply by 0.0135
digitalWrite(trigPin2, LOW);
delayMicroseconds(5);
digitalWrite(trigPin2, HIGH);
delayMicroseconds(10);
digitalWrite(trigPin2, LOW);
pinMode(echoPin2, INPUT);
duration2 = pulseIn(echoPin2, HIGH);
cm2 = (duration2 / 2) / 29.1; // Divide by 29.1 or multiply by 0.0343
inches2 = (duration2 / 2) / 74; // Divide by 74 or multiply by 0.0135
digitalWrite(trigPin3, LOW);
delayMicroseconds(5);
digitalWrite(trigPin3, HIGH);
delayMicroseconds(10);
digitalWrite(trigPin3, LOW);
pinMode(echoPin3, INPUT);
duration3 = pulseIn(echoPin3, HIGH);
cm3 = (duration3 / 2) / 29.1; // Divide by 29.1 or multiply by 0.0343
inches3 = (duration3 / 2) / 74; // Divide by 74 or multiply by 0.0135
digitalWrite(trigPin4, LOW);
delayMicroseconds(5);
digitalWrite(trigPin4, HIGH);
delayMicroseconds(10);
digitalWrite(trigPin4, LOW);
pinMode(echoPin4, INPUT);
duration4 = pulseIn(echoPin4, HIGH);
cm4 = (duration4 / 2) / 29.1; // Divide by 29.1 or multiply by 0.0343
inches4 = (duration4 / 2) / 74; // Divide by 74 or multiply by 0.0135
40
//Printing inches and centimeters (optional)
/*Serial.print(inches1);
Serial.print("in1, ");
Serial.print(inches2);
Serial.print("in2, ");
Serial.print(inches3);
Serial.print("in3, ");
Serial.print(inches4);
Serial.print("in4, ");
Serial.print(cm1);
Serial.print("cm1 ");
Serial.print(cm2);
Serial.print("cm2 ");
Serial.print(cm3);
Serial.print("cm3 ");
Serial.print(cm4);
Serial.print("cm4 ");
Serial.println();*/
//Just to be sure that gyro is not zero and robot started to climbing the
stairs
analogWrite(enA, 100);
analogWrite(enB, 100);
digitalWrite(in1, HIGH);
digitalWrite(in2, LOW);
digitalWrite(in3, HIGH);
digitalWrite(in4, LOW);
delay(300);
digitalWrite(in1, LOW);
digitalWrite(in2, LOW);
digitalWrite(in3, LOW);
digitalWrite(in4, LOW);
}
}
void climbing() {
Serial.print("CLIMBING");
analogWrite(enA, 100);
analogWrite(enB, 100);
digitalWrite(in1, HIGH);
digitalWrite(in2, LOW);
digitalWrite(in3, HIGH);
digitalWrite(in4, LOW);
}
41
APPENDIX B
42
300
45
40
20
105
45 R5
0
O.
60
6
.
8 7 6 5 4 3 2 1
1 3 5 4 6 7
2
F F
ITEM NO. PART NUMBER DESCRIPTION QTY.
6 Part 6 Joint F 2
2
D 7 Part 7 Joint M 2
D
8 Part 8 T-Pipe Joint 1
C C
B B
UNLESS OTHERWISE SPECIFIED: DEBURR AND
BREAK DO NOT SCALE DRAWING REVISION
FINISH: DIMENSIONS ARE IN MILLIMETERS SHARP
SURFACE EDGES
FINISH:
TOLERANCES:
LINEAR:
ANGULAR:
SIGNATURE
DRAWN
CHK'D
APPV'D
DWG NO.
A
A MATERIA
Q.A
L: A3
NO.
45
60
170
180
240
270
5
R2
R9
5
10
R2
190
5
0
24
RESİM
NO.
52,50
14
R1
10
2
R3
R9
220
R4
2
R10
0
R26 R32
R40
0
20
6
20
4
R3
R2
0°
12
5
R3,1
30
30
R42,50
30
3,4
0