SELF STABILIZING PLATFORM

Similar documents
DC motor control using arduino

The Mathematics of the Stewart Platform

Control System Design for Tricopter using Filters and PID controller

FLCS V2.1. AHRS, Autopilot, Gyro Stabilized Gimbals Control, Ground Control Station

GPS System Design and Control Modeling. Chua Shyan Jin, Ronald. Assoc. Prof Gerard Leng. Aeronautical Engineering Group, NUS

Feedback Devices. By John Mazurkiewicz. Baldor Electric

Design and Implementation of FPGA Based Quadcopter

Design and Development of Novel Two Axis Servo Control Mechanism

HAND GESTURE CONTROLLED ROBOT USING ARDUINO

Classical Control Based Autopilot Design Using PC/104

KINECT CONTROLLED HUMANOID AND HELICOPTER

IMU: Get started with Arduino and the MPU 6050 Sensor!

Gesture Identification Using Sensors Future of Interaction with Smart Phones Mr. Pratik Parmar 1 1 Department of Computer engineering, CTIDS

DESIGN OF A TWO DIMENSIONAL MICROPROCESSOR BASED PARABOLIC ANTENNA CONTROLLER

AUTOPILOT CONTROL SYSTEM - IV

Automobile Prototype Servo Control

MICRO AERIAL VEHICLE PRELIMINARY FLIGHT CONTROL SYSTEM

Robotic Swing Drive as Exploit of Stiffness Control Implementation

International Journal of Advance Engineering and Research Development

Job Sheet 2 Servo Control

THE IMPORTANCE OF PLANNING AND DRAWING IN DESIGN

Page ENSC387 - Introduction to Electro-Mechanical Sensors and Actuators: Simon Fraser University Engineering Science

MEM380 Applied Autonomous Robots I Winter Feedback Control USARSim

Introducing the Quadrotor Flying Robot

Feed-back loop. open-loop. closed-loop

Mechatronics Engineering and Automation Faculty of Engineering, Ain Shams University MCT-151, Spring 2015 Lab-4: Electric Actuators

CENG 5931 HW 5 Mobile Robotics Due March 5. Sensors for Mobile Robots

IMU Platform for Workshops

istand I can Stand SPECIAL SENSOR REPORT

Autonomous Machine To Manufacture PCB and 3-D Design

Interfacing dspace to the Quanser Rotary Series of Experiments (SRV02ET)

MASTER SHIFU. STUDENT NAME: Vikramadityan. M ROBOT NAME: Master Shifu COURSE NAME: Intelligent Machine Design Lab

3DM-GX4-45 LORD DATASHEET. GPS-Aided Inertial Navigation System (GPS/INS) Product Highlights. Features and Benefits. Applications

A3 Pro INSTRUCTION MANUAL. Oct 25, 2017 Revision IMPORTANT NOTES

TEAM AERO-I TEAM AERO-I JOURNAL PAPER DELHI TECHNOLOGICAL UNIVERSITY Journal paper for IARC 2014

Study of M.A.R.S. (Multifunctional Aero-drone for Remote Surveillance)

Robotic Navigation Distance Control Platform

SimpleBGC 32bit controllers Using with encoders. Last edit date: 23 October 2014 Version: 0.5

Understanding RC Servos and DC Motors

Exercise 2-2. Antenna Driving System EXERCISE OBJECTIVE DISCUSSION OUTLINE DISCUSSION

ARKBIRD-Tiny Product Features:

Application of an Inertial Navigation System to the Quad-rotor UAV using MEMS Sensors

OughtToPilot. Project Report of Submission PC128 to 2008 Propeller Design Contest. Jason Edelberg

FABO ACADEMY X ELECTRONIC DESIGN

MOBILE ROBOT LOCALIZATION with POSITION CONTROL

Introduction: Components used:

TigreSAT 2010 &2011 June Monthly Report

3-Degrees of Freedom Robotic ARM Controller for Various Applications

Servo Tuning. Dr. Rohan Munasinghe Department. of Electronic and Telecommunication Engineering University of Moratuwa. Thanks to Dr.

Project 27 Joystick Servo Control

Module 2: Lecture 4 Flight Control System

of harmonic cancellation algorithms The internal model principle enable precision motion control Dynamic control

Analog Devices: High Efficiency, Low Cost, Sensorless Motor Control.

Glossary. Glossary Engineering Reference. 35

Step vs. Servo Selecting the Best

ServoStep technology

SRV02-Series Rotary Experiment # 3. Ball & Beam. Student Handout

Accelerometer Products

UNIVERSITY OF NORTH CAROLINA AT CHARLOTTE

Sensor system of a small biped entertainment robot

SMART SENSORS AND MEMS

PRODUCTS AND LAB SOLUTIONS

Design and Control of a Self-Balancing Autonomous Underwater Vehicle with Vision and Detection Capabilities

ME375 Lab Project. Bradley Boane & Jeremy Bourque April 25, 2018

EL6483: Sensors and Actuators

MXD7210GL/HL/ML/NL. Low Cost, Low Noise ±10 g Dual Axis Accelerometer with Digital Outputs

MAGNETIC LEVITATION SUSPENSION CONTROL SYSTEM FOR REACTION WHEEL

Embedded Robust Control of Self-balancing Two-wheeled Robot

Brushed DC Motor Microcontroller PWM Speed Control with Optical Encoder and H-Bridge

User Manual Version 1.0

Dynamically Adaptive Inverted Pendulum Platfom

ANN BASED ANGLE COMPUTATION UNIT FOR REDUCING THE POWER CONSUMPTION OF THE PARABOLIC ANTENNA CONTROLLER

Control System for a Segway

P07122 Autonomous Quadcopter Mechanical Assembly Instructions

302 VIBROENGINEERING. JOURNAL OF VIBROENGINEERING. MARCH VOLUME 15, ISSUE 1. ISSN

X3M. Multi-Axis Absolute MEMS Inclinometer Page 1 of 13. Description. Software. Mechanical Drawing. Features

BW-IMU200 Serials. Low-cost Inertial Measurement Unit. Technical Manual

A COMPARISON STUDY OF THE COMMUTATION METHODS FOR THE THREE-PHASE PERMANENT MAGNET BRUSHLESS DC MOTOR

Engineering Reference

Recent Progress in the Development of On-Board Electronics for Micro Air Vehicles

Entry #287 SONORAN ULTRASONIC CAVE MAPPING PLATFORM PSOC DESIGN CONTEST entry #287. Page 1

ME 434 MEMS Tuning Fork Gyroscope Amanda Bristow Stephen Nary Travis Barton 12/9/10

Control Design for Servomechanisms July 2005, Glasgow Detailed Training Course Agenda

MEMS Accelerometer sensor controlled robot with wireless video camera mounted on it

Pulse-Width Modulation (PWM)

Electronic Speed Controls and RC Motors

A 3D Gesture Based Control Mechanism for Quad-copter

Testing Autonomous Hover Algorithms Using a Quad rotor Helicopter Test Bed

NAMASKAR ROBOT-WHICH PROVIDES SERVICE

Active Vibration Isolation of an Unbalanced Machine Tool Spindle

Allen-Bradley. Using the 1756-MO2AE with the TR Encoder (Cat. No ) Application Note

CMPS09 - Tilt Compensated Compass Module

Master Thesis Presentation Future Electric Vehicle on Lego By Karan Savant. Guide: Dr. Kai Huang

5. Transducers Definition and General Concept of Transducer Classification of Transducers

Design and Implementation of FPGA-Based Robotic Arm Manipulator

The Allen-Bradley Servo Interface Module (Cat. No SF1) when used with the Micro Controller (Cat. No UC1) can control single axis

High Performance Advanced MEMS Industrial & Tactical Grade Inertial Measurement Units

ROBOTICS & EMBEDDED SYSTEMS

PRODUCTS AND LAB SOLUTIONS

PWM LED Color Control

Transcription:

SELF STABILIZING PLATFORM Shalaka Turalkar 1, Omkar Padvekar 2, Nikhil Chavan 3, Pritam Sawant 4 and Project Guide: Mr Prathamesh Indulkar 5. 1,2,3,4,5 Department of Electronics and Telecommunication, Vidyalankar Institue of Technology, Wadala, Mumbai, Maharashtra. Abstract This paper presents a development of selfbalancing platform mechanism using ATMEGA microcontroller. The platform has been designed using stabilizing mechanism including Inertial measurement unit (IMU) and two servos, and controlled by an open source microcontroller. In this project the ATMEGA- 328 microcontroller, servos, and a two-degree of freedom (axis) accelerometer have been used to create the controlled platform. The controller has been designed to maintain the platform at an initially selected angle when the support structure orientation changes. The software has been written with logic to convert the digital data from the accelerometer to an acceleration magnitude vector. The magnitude is then compared to a predetermined mathematical function to infer the angle of tilt of the platform. The angle of tilt is then converted to angle of rotation for the servos to act on. Index Terms Accelerometer, IMU unit, Microcontroller, Pan Tilt, Self balancing platform, Servo motor. I. INTRODUCTION In our day to day life many more micro-electronics components exist with the very good equipment quality and performances. In this area, one is Micro electro-mechanical systems (MEMS) sensors and devices [2]. The components and devices required complete this is of cheap in cost, low energy and light in weight. In this paper sensors and other devices used are ADXL-345[1, 2, 8], servo motors [3, 4] and ATMEGA-328P [5] controller. This is widely required in products from small handheld cameras up to the defence helicopters, aircrafts and medical devices while performing precise surgeries. This paper describes easy implementation of self-balanced platform with standard part available. This is the basic concept use in auto pilot mode in aero plane. In this airplane balances itself in air without help of pilot and try to remain parallel with respect to ground level. In self-balancing platform the main components are position sensors, microcontroller and dc motor. In the implementation, we met also some problems that have been solved. One of the major applications of stabilizing platform is in self-levelling equipment like anti-motion sickness chairs [7] which causes vomiting to the travellers. II. PURPOSE The motive of the paper is to enhance the understanding of digital control devices and how it can be used to balance a platform. Also this paper is useful to analyse how close loop systems can be used along with accelerometers and gyroscope sensors to stabilize the platform. In this paper stabilization will be accomplished by using ATMEGA-328P microcontroller and an IMU unit (an accelerometer sensor) which gives feedback to two servo-motors. The purpose is also to study how the system reacts to both a symmetrically and an asymmetrically placed objects on platform. To simplify the theoretical model is considered with object is placed on the middle of the platform and tested. III. BLOCK DIAGRAM A self-stabilizing platform usually takes in account at least two angles; roll and pitch [6]. The purpose of IJIRT 144442 INTERNATIONAL JOURNAL OF INNOVATIVE RESEARCH IN TECHNOLOGY 220

such a platform is to maintain close-to zero degrees of angle towards the direction of gravity, in other words, to stay horizontal. In order to achieve this each angle has to be measured. This can be done in a number of ways. A rotary encoder can be used to measure the rotation of the motor shaft and have the motor adjust accordingly. Another option is to use a device capable of measuring the platforms current angle, such as a gyroscope and accelerometer combination. This also enables the system to cope with the mounting (base) platform being tilted, unlike the encoder solution which can only adjust when the motor is rotated. An IMU of the scale used for this project often consists of a combination of three accelerometers and three gyroscopes placed orthogonally to each other, representing a coordinate system. An accelerometer measures G-forces, or inertial acceleration. The accelerometer is a sensor that measures acceleration in a predefined axis. The sensor can provide a reference point to determine which way is up versus down orientation. A gyroscope measures its rotational position in relation to an arbitrarily chosen coordinate system. A gyroscope will have an accumulating error and can as such often not be used alone while an accelerometer has a problem with the gravity component. These two are fortunately easily combined and will compensate each other weaknesses very well. The servo circuitry is built right inside the motor unit and has a positional shaft, which usually is fitted with a gear. The motor is controlled with an electric signal which determines the amount of movement of the shaft. Servos are controlled by sending an electrical pulse of variable width, or pulse width modulation (PWM), through the control wire. The PWM signal is a pulse of ones and zeros allowing the voltage to be set to a percentage of the maximum output voltage of the used channel. A PWM signal is usually between 0 and 255, where 0 is 0% of the available output voltage and 255 is 100%. Over a pulse, a signal of 127 will result in the signal sent being one for half of the period, and zero for the rest. This will be interpreted by the motor as a voltage of half the maximum voltage. There is a minimum pulse, a maximum pulse, and a repetition rate. A servo motor can usually only turn 90 in either direction for a total of 180 movement. The motor's neutral position is defined as the position where the servo has the same amount of potential rotation in the both the clockwise or counter-clockwise direction. The PWM sent to the motor determines position of the shaft, and based on the duration of the pulse sent via the control wire; the rotor will turn to the desired position. The servo motor expects to see a pulse every 20 milliseconds and the length of the pulse will determine how far the motor turns. The movement of servo is decided from PWM signal as follows. For example, a 1.5ms pulse will make the motor turn to the 90 position. Shorter than 1.5ms moves it in the counter clockwise direction toward the 0 position, and any longer than 1.5ms will turn the servo in a clockwise direction toward the 180 position. Depending upon the amount of change in position of Platform and direction controller energies respective motor to bring platform back to is originally/ stable position. Two dc motor are attached to platform one from top end and other from bottom with help of string such that it is parallel with respect to ground level. IV. FLOW CHART In this the digital signal processing takes in the output from the accelerometer and outputs a PWM signal to the RC servomotors. The first portion of the code initializes the processors and variables for use. Then, the code enters an infinite while loop to continually execute the code. Then the analog value tilt angle X and Y are converted into digital values and further this digital values are converted into X and Y degrees, respectively. Then, the PWM pulse width is calculated using the X and Y degrees. In this closed loop version, the PWM widths of X and Y are increased or decreased depending on the tilt degrees until the tilt degrees for X and Y are reporting a zero degree inclination. The RC servomotor controlling the X and Y axis has a PWM width determined by a simple linear relationship with respect to the inclination. Once the PWM width is determined (in ms), we scale it to our PWM period and then set those PWM values. Once the PWM signal is set, the code returns to the top of the IJIRT 144442 INTERNATIONAL JOURNAL OF INNOVATIVE RESEARCH IN TECHNOLOGY 221

loop and repeats the block of code again. A programming flowchart is shown in figure 1. START V. RESULT In this project, we got the output as stabilized platform as shown in figure (a). Means for any movement of the movable platform the main INITIALIZE ALL VARIABLES ASSIGN ALL HARDWARE PINS CONVERT ANALOG DATA INTO DIGITAL DATA READ ACCELEROMETER VALUE CHANGE DIGITAL DATA INTO ACCELERATION Figure (a) Normal position Platform remains parallel to the earth surface as shown in figure (a). As shown in figure (a) accelerometer is mounted on the wooden base which will act as a base platform, middle square is use for horizontal levelling and inner square will use for vertical movement. In this, if we move the base platform towards the north side then the inner platform (vertically adjustable platform) will move in opposite direction that means it will move towards the south. From this we can say that movement of the movable platform is inversely proportional to the base platform. CONVERT ACCELERATION INTO TILT CHANGE TILT INTO SERVO ANGLE Figure (b) vertically stabilized. CONVERT SERVO ANGLE INTO PWM PULSE In the figure (b) the platform is stabilized horizontally. Means after moving the outer platform towards west the middle platform moves towards east and get stabilized. SEND PWM PULSES TO SERVOS Figure (1). Figure (1). Figure (1) IJIRT 144442 INTERNATIONAL JOURNAL OF INNOVATIVE RESEARCH IN TECHNOLOGY 222

SCOPE OF PROJECT a) Precise medical surgeries. This is very useful in ships for medical operations precisely by keeping to patients stable. Same can be used in ambulances. Figure (c) horizontally stabilized In the figure (c) we move base platform towards west then according to the signal to the motor it will move towards the east. Figure (d) horizontally and vertically stabilized. In this we move this in direction other than the primary directions (East, West, North, and South). Due to this both the inner platforms will move in the opposite direction in which base platform is move. And we get the stable platform. From all above figures, we can say that, the movement of the inner platform and base platform is totally opposite. Both the inner platform is adjusted to the appropriate direction with respect to the movement of base platform to keep the inner platforms parallel to the earth surface. VI. CONCLUSION Our project is capable to stabilize the movable platform at a constant position. That means this platform will remain parallel to the earth surface. This can be used in many applications like Ships, Vehicles, Ambulance, Camera for entertainment and safety purpose. b) Aircrafts stabilizer. An aircraft stabilizer is an aerodynamic surface, it includes one or more movable control surfaces, that provides longitudinal (pitch) and directional (yaw) stability and control. A stabilizer can feature a fixed or adjustable structure on which any movable control surfaces are hinged, or it can itself be a fully movable surface such as a stabiliser. c) Antenna stabilizer. This is use where the antennas are placed at high heights, which get affect because of wind. Due to this communication can be break, so antenna stabilizer helps to keep antenna at a unique position and communication will take place without any problem. d) Camera stabilizing. Self-stabilization can be used to stable the cameras in films and in photography. e) Stabilizing platform in vehicles to prevent motion sickness. In this the sheets can be place on a single platform and this platform can be stabilized using this concept, due to which motion sickness problem can be solve. REFERENCE [1] IMUSENSORhttps://www.researchgate.net/pu blication/228995014_study_of_inertial_meas urement_unit_sensor [2] MEMSregistermaphttp://invensense.com/mem s/gyro/documents/rmmpu6000a.pdf(17.1.2 014) [3] Servomotorhttp://www.princeton.edu/~mae41 2/TEXT/NTRAK2002/292-302.pdf [4] Servomotorhttp://robokits.co.in/motors/microservo-9g [5] ATMEGA328phttp://www.atmel.com/Images/ Atmel427358bitAVRMicrocontrollerATmega 328-328P_Datasheet.pdf [6] Anglescontrolledbyservohttp://howthingsfly.si.edu/flight-dynamics/roll-pitch-and-yaw [7] Antimotionsicknesshttp://www.google.co.in/p atents/us20040035347 IJIRT 144442 INTERNATIONAL JOURNAL OF INNOVATIVE RESEARCH IN TECHNOLOGY 223

[8] http://www.analog.com/en/products/mems/acc elerometers/adxl345.html#productdocumentat ion IJIRT 144442 INTERNATIONAL JOURNAL OF INNOVATIVE RESEARCH IN TECHNOLOGY 224