Roboti ENG

Embed Size (px)

Citation preview

  • 8/8/2019 Roboti ENG

    1/37

    LEGO Mindstorms NXT

    - sensors and electronics

    in NXT robots

    Pavel Ripka, (modified by Vojtch Petrucha)

    Department of Measurement, CTU in Prague

    http://measure.feld.cvut.cz

  • 8/8/2019 Roboti ENG

    2/37

    Sensors ?

    Interface between a real world and

    your control algorithms and artificialintelligence (robots)

    A sensor is a device that measures a

    physical quantity and converts it into a

    signal which can be read by an

    observer or by an instrument. (Wiki)a

  • 8/8/2019 Roboti ENG

    3/37

    Whats this?

  • 8/8/2019 Roboti ENG

    4/37

    1.5 2 billions US$ burning..

  • 8/8/2019 Roboti ENG

    5/37

    B2 Spirit

    Moisture in three of the 24 sensors that

    feed information into the bombers

    computer system caused the sensors to

    send bad information about the planes

    speed and altitude, and howfar up or

    down the bombers nose was pointed.

  • 8/8/2019 Roboti ENG

    6/37

    NXT brick

    http://mindstorms.leg

    o.com/Overvie

    w/NXTreme.aspxhttp://www.jstuber.net/lego/nxt-programming/nxt-top_big.jpg

    Main processor: Atmel 32-bit AR

    M

    processor, AT91SAM7S256

    - 256 KB FLASH

    - 64 KB RAM

    - 48 MHz

    Co-processor: Atmel 8-bit AVR

    processor, ATmega48

    - 4 KB FLASH

    - 512 Byte RAM

    - 8 MHz

  • 8/8/2019 Roboti ENG

    7/37

    4input ports

    1: analog input 10-bit ADC 0..5 V+ current generator (back compatibility with RCX)

    2, 3: GND

    4: + 4,3 V 5,6: digital I-O, I2C bus (Inter-Integrated Circuit)

    (only the ultrasonic sensor uses it from the basic set..)

    I2C half-duplex communication,

    START,ADDRESS,ACKNOWLEDGE, DATA , STOP

  • 8/8/2019 Roboti ENG

    8/37

    3 output ports

    1-2 PWM outputs for motors (or programmable voltage 0..5 V) 3 GND

    4 power supply 4,3 V

    5,6 Schmitt inputs (e.g. for IRC sensor - encoder)

  • 8/8/2019 Roboti ENG

    9/37

    Touch sensor

  • 8/8/2019 Roboti ENG

    10/37

    measures level of soundmagnitude acoustic pressure

    0 dB you can here it..

    120 (130) dB level of pain

    Microphone

    A5M02AKA Akustick aplikace

    dBa .... physiological correction

    it shows percents [%] of90 dB

    4-5% silent room

    5-10% far conversation

    10-30% normal conversation

    30-100% screaming or noisy music

    20 dB = one order increase

  • 8/8/2019 Roboti ENG

    11/37

    Ultrasonic range-meter

    measures distance 0 (?) to 255 centimeters with a resolution

    +/- 3 cm.

    principle: time offlight

    piezoelectric transmitter and receiver(separated)

    speed ofsound 346 m/s (changing with

    temperature, pressure)

    good reflection is needed

  • 8/8/2019 Roboti ENG

    12/37

  • 8/8/2019 Roboti ENG

    13/37

    Motor and IRC sensor

    If you use the Move block in the LEGO

    MINDSTORMSNXT software to program your

    motors, the two motors will automatically

    synchronize, so that your robot will move in a

    straight line.

    Rotation Sensor measures motor rotations in

    degrees or full rotations [accuracy of +/- one

    degree].

  • 8/8/2019 Roboti ENG

    14/37

    motor characteristics

    http://www.philohome.com/motors/motorcomp.htm

  • 8/8/2019 Roboti ENG

    15/37

    How you can

    measure the

    torque

    http://www.philohome.com/motors/motorcomp.htm

  • 8/8/2019 Roboti ENG

    16/37

    Motor efficiency

    A3B14EPR Elektrick pohony pro automatizaci a robotiku

  • 8/8/2019 Roboti ENG

    17/37

    Overload protection ofNXT motor

    current through braked motor: 2 A,

    momentum 50N.cm

    in-build PTC thermistor over-voltage diode (D4) .. both polarities 15 V

    http://www.philohome.com/motors/motorcomp.htm

  • 8/8/2019 Roboti ENG

    18/37

    Motor control H bridge

  • 8/8/2019 Roboti ENG

    19/37

    IRC sensor

    - like in a computer mouse

  • 8/8/2019 Roboti ENG

    20/37

    counts on rising and falling edges (direction and resolution)

    Non-magnetic platform, also contains IRCs. Code-wheel made ofPCB, no

    ferromagnetic components..

  • 8/8/2019 Roboti ENG

    21/37

    Simple I2C interface

  • 8/8/2019 Roboti ENG

    22/37

    Connection ofDACand VCO for RC servo

    http://www.extremenxt.com/tda8444.html

    A3M38ZDS Zpracovn a digitalizace analogovch signl

  • 8/8/2019 Roboti ENG

    23/37

    Communication

    Bluetooth wireless communication

    CSR BlueCoreTM 4 v2.0 +EDR System

    1 master + max. 3 slave

    USB 2.0 communication Full speed port

    12 Mbit/s

  • 8/8/2019 Roboti ENG

    24/37

    USB connection Control Transfer

    Isochronous Transfer

    Interrupt Transfer

    Bulk Transfer

  • 8/8/2019 Roboti ENG

    25/37

    BluetoothBluetooth wireless

    communication CSR

    BlueCoreTM 4 v2.0

    +EDR System

    -Supporting the Serial

    Port Profile (SPP)

    - Internal 47 KByte RAM

    - External 8 MBit FLASH

    - 26 MHz

  • 8/8/2019 Roboti ENG

    26/37

    LCD display control

  • 8/8/2019 Roboti ENG

    27/37

    Sound output channel with 8-bit resolution

    - Supporting a sample rate of2-16 KHz

  • 8/8/2019 Roboti ENG

    28/37

    Battery6 AA cells or Li-Ion accu

    reversible fuse 1,85 A (disconnects at about 3,3 A

    5 V stab. 3,3 V stab. for ARM7 a Bluecore

  • 8/8/2019 Roboti ENG

    29/37

    Other sensors forNXT

    Infrared range-meter (triangulation)

    20 150 cm, resolution mmConnection I2C

    Sharp GP2Y0A02YK sensor

    http://www.mindsensors.com

    http://www.eduxe.cz/legomenu/hitechnic_menu.htm

    +i

    -ii

    A

    C

    o

    y=0+y -y

    cl

    laserovdioda

    y

    he l t yp ic k y nas taven na 30 50

    5

    5

    i=0 xi

    x0 xs

    detektor

  • 8/8/2019 Roboti ENG

    30/37

    Compass

    Ourwo

    rk..

  • 8/8/2019 Roboti ENG

    31/37

    Digital Camera

    Ourwork

    Where we teach it..: A3M38VBM L

    Videometrie a bezkontaktn men

  • 8/8/2019 Roboti ENG

    32/37

    Accelerometer

    mindsensors

    hitechnic

    a

    UA

    UA

    UB

    UB

    UC

    UC

    N S

    0V

    0V

    ZS D

    G1 M H z

    R

    N O

    CDP

    R E F

    4

    m

    2 5 3

    1

  • 8/8/2019 Roboti ENG

    33/37

    Gyro

    http://web.mac.com/ryo_watanabe

    video http://www.youtube.com/watch?v=V40ScvJeFxg

    Prezentace NTXway-G

  • 8/8/2019 Roboti ENG

    34/37

    Gyroscope

    (iMEMS by Analog Devices)

  • 8/8/2019 Roboti ENG

    35/37

    Real operation

  • 8/8/2019 Roboti ENG

    36/37

    Pressure

    http://www.extremenxt.com/pressure.htm

    mindsensors

  • 8/8/2019 Roboti ENG

    37/37

    Other applications

    RFID reader http://www.norgesgade14.dk/rfid.phpMicroprocesor communicates with NXT using I2C

    HiTechnic Products http://www.hitechnic.com

    Codatex RFID sensor http://www.codatex.com