Open Modular Snake Robot Software Architecture Juan Leon, Jose - - PowerPoint PPT Presentation

open modular snake robot software architecture
SMART_READER_LITE
LIVE PREVIEW

Open Modular Snake Robot Software Architecture Juan Leon, Jose - - PowerPoint PPT Presentation

Open Modular Snake Robot Software Architecture Juan Leon, Jose Monsalve, Alvaro di Zeo, Laura Paez and Kamilo Melo { juan.leon,laura.paez,kamilo.melo } @km-robota.com KM-ROBOTA Research Group, KM-ROBOTA S.A.S. Bogota - Colombia www.km-robota.com


slide-1
SLIDE 1

Open Modular Snake Robot Software Architecture

Juan Leon, Jose Monsalve, Alvaro di Zeo, Laura Paez and Kamilo Melo {juan.leon,laura.paez,kamilo.melo}@km-robota.com KM-ROBOTA Research Group, KM-ROBOTA S.A.S. Bogota - Colombia www.km-robota.com . ICRA2013, SDIR 8 workshop - Karlsruhe, Germany May 6, 2013

1 / 28

slide-2
SLIDE 2

Motivation

2 / 28

slide-3
SLIDE 3

Introduction

Figure: 16-DOF Lola-OPTM, Modular Snake Robot

http://www.km-robota.com http://www.robotsource.org

3 / 28

slide-4
SLIDE 4

Introduction, Current Gait Control

Parameterized gaits θ(n, t) =        Oo + AoSin n λo + ωot

  • , n odd

Oe + AeSin n λe + ωet + δ

  • , n even

(1) Scripted Gaits.

4 / 28

slide-5
SLIDE 5

Framework Architecture Information Flow

Framework Architecture, Information Flow

Virtual Environment

  • V. Exo.

Sensors

  • V. Robot

Forward Kinematics

  • V. Prop.

Sensors Exo. Sensors

Robot

Forward Kinematics Prop. Sensors

DAQ Plotting User Input High level task input Controller Log

Protocol Selector Message Passing Protocol Converter Parameterized Scripted

Look-Up Table Control

Control Interfaces

FK Plotting Tool

Animation

Figure: Simulation and Control Framework Architecture.

5 / 28

slide-6
SLIDE 6

Framework Architecture Information Flow

Framework Architecture, Model-View-Controller Model View Controller

Figure: Model-View-Controller Architecture.

6 / 28

slide-7
SLIDE 7

Framework Architecture Information Flow

Framework Architecture, Information Flow

Virtual Environment

  • V. Exo.

Sensors

  • V. Robot

Forward Kinematics

  • V. Prop.

Sensors Exo. Sensors

Robot

Forward Kinematics Prop. Sensors

DAQ Plotting User Input High level task input Controller Log

Protocol Selector Message Passing Protocol Converter Parameterized Scripted

Look-Up Table Control

Control Interfaces

FK Plotting Tool

Animation

Figure: Simulation and Control Framework Architecture.

7 / 28

slide-8
SLIDE 8

Framework Architecture Information Flow

Information Flow - Open Loop Robot Test

Virtual Environment

  • V. Exo.

Sensors

  • V. Robot

Forward Kinematics

  • V. Prop.

Sensors Exo. Sensors

Robot

Forward Kinematics Prop. Sensors

DAQ Plotting User Input High level task input Controller Log

Protocol Selector Message Passing Protocol Converter Parameterized Scripted

Look-Up Table Control

Control Interfaces

FK Plotting Tool

Animation

Figure: Open Loop Test.

8 / 28

slide-9
SLIDE 9

Framework Architecture Information Flow

Information Flow - Open Loop Simulation Run

Virtual Environment

  • V. Exo.

Sensors

  • V. Robot

Forward Kinematics

  • V. Prop.

Sensors Exo. Sensors

Robot

Forward Kinematics Prop. Sensors

DAQ Plotting User Input High level task input Controller Log

Protocol Selector Message Passing Protocol Converter Parameterized Scripted

Look-Up Table Control

Control Interfaces

FK Plotting Tool

Animation

Figure: Open Loop Simulation Run.

9 / 28

slide-10
SLIDE 10

Framework Architecture Information Flow

Information Flow - Closed Loop Experiment

Virtual Environment

  • V. Exo.

Sensors

  • V. Robot

Forward Kinematics

  • V. Prop.

Sensors Exo. Sensors

Robot

Forward Kinematics Prop. Sensors

DAQ Plotting User Input High level task input Controller Log

Protocol Selector Message Passing Protocol Converter Parameterized Scripted

Look-Up Table Control

Control Interfaces

FK Plotting Tool

Animation

Figure: Closed Loop Experiment.

10 / 28

slide-11
SLIDE 11

Framework Architecture Forward Kinematics Plotting Tool

Forward Kinematics Plotting Tool

Virtual Environment

  • V. Exo.

Sensors

  • V. Robot

Forward Kinematics

  • V. Prop.

Sensors Exo. Sensors

Robot

Forward Kinematics Prop. Sensors

DAQ Plotting User Input High level task input Controller Log

Protocol Selector Message Passing Protocol Converter Parameterized Scripted

Look-Up Table Control

Control Interfaces

FK Plotting Tool

Animation

Figure: Forward Kinematics Plotting Tool

11 / 28

slide-12
SLIDE 12

Framework Architecture Forward Kinematics Plotting Tool

Forward Kinematics Plotting Tool

Figure: Forward Kinematics Plotting Tool examples.

12 / 28

slide-13
SLIDE 13

Framework Architecture Forward Kinematics Plotting Tool

Forward Kinematics Plotting Tool

Figure: Forward Kinematics Plotting Tool examples.

13 / 28

slide-14
SLIDE 14

Framework Architecture Forward Kinematics Plotting Tool

Forward Kinematics Plotting Tool

Figure: Forward Kinematics Plotting Tool examples.

14 / 28

slide-15
SLIDE 15

Framework Architecture Message Passing Protocol Converter

Message Passing Protocol Converter

Virtual Environment

  • V. Exo.

Sensors

  • V. Robot

Forward Kinematics

  • V. Prop.

Sensors Exo. Sensors

Robot

Forward Kinematics Prop. Sensors

DAQ Plotting User Input High level task input Controller Log

Protocol Selector Message Passing Protocol Converter Parameterized Scripted

Look-Up Table Control

Control Interfaces

FK Plotting Tool

Animation

Figure: Message Passing Protocol Converter

15 / 28

slide-16
SLIDE 16

Framework Architecture Message Passing Protocol Converter

Message Passing Protocol Converter

DAQ Plotting User Input High level task input Controller Log

Protocol Selector Message Passing Protocol Converter Parameterized Scripted

Look-Up Table Control

Control Interfaces

FK Plotting Tool

Lola-OPTM Kulebra-OPTM NTNU KulKo CMU Uncle Sam Lola-OP Simulator

KM-RoBoT a s.a.s.

Figure: Message Passing Protocol Converter

16 / 28

slide-17
SLIDE 17

Framework Architecture Log File and Real-Time Plotting

Log File and Real-Time Plotting

Virtual Environment

  • V. Exo.

Sensors

  • V. Robot

Forward Kinematics

  • V. Prop.

Sensors Exo. Sensors

Robot

Forward Kinematics Prop. Sensors

DAQ Plotting User Input High level task input Controller Log

Protocol Selector Message Passing Protocol Converter Parameterized Scripted

Look-Up Table Control

Control Interfaces

FK Plotting Tool

Animation

Figure: Message Passing Protocol Converter

17 / 28

slide-18
SLIDE 18

Framework Architecture Log File and Real-Time Plotting

Log File and Real-Time Plotting

Virtual Environment

  • V. Exo.

Sensors

  • V. Robot

Forward Kinematics

  • V. Prop.

Sensors Exo. Sensors

Robot

Forward Kinematics Prop. Sensors

DAQ Plotting User Input High level task input Controller Log

Protocol Selector Message Passing Protocol Converter Parameterized Scripted

Look-Up Table Control

Control Interfaces

FK Plotting Tool

Animation

Kde-KST Figure: Message Passing Protocol Converter

18 / 28

slide-19
SLIDE 19

Control Interfaces

Control Interfaces

Scripted Gaits Front End Parameterized Gaits Front End High Level Controller

19 / 28

slide-20
SLIDE 20

Control Interfaces Scripted Gaits Front-end

Control Interfaces - Scripted Gaits Front-end

Figure: Scripted Gaits Front-end.

20 / 28

slide-21
SLIDE 21

Control Interfaces Parameterized Gaits Front-end

Control Interfaces - Parameterized Gaits Front-end

Figure: Scripted Gaits Front-end.

21 / 28

slide-22
SLIDE 22

Control Interfaces High Level Controller

Control Interfaces - High Level Controller

Log file Ready to be used ...

22 / 28

slide-23
SLIDE 23

Physics Simulator

Physics Simulator

Physics simulator structure of classes Simulator Control (process pipeline) Physics Processor (solves the interaction) Snake Container (joints+actuators) Graphics Processor (visual rep) Data Processor (input/output)

23 / 28

slide-24
SLIDE 24

Physics Simulator

Physics Simulator Examples

24 / 28

slide-25
SLIDE 25

Framework Integration Error Handling

Framework Integration

Error Handling... Three sources of error Invalid Data Input Communication Failure Unbounded control signal

25 / 28

slide-26
SLIDE 26

Framework Integration Controller and High Level Task Input

Controller and High Level Task Input

Add/Remove components Embedded on-board, Tested on TI ARM R Cortex-A8TMprocessors on Gumstix Overo R boards (https://www.gumstix.com/) and Atmel ATMega2561 processor on Dynamixel CM-700 controller (http://support.robotis.com/).

26 / 28

slide-27
SLIDE 27

Conclusions

Conclusions

27 / 28

slide-28
SLIDE 28

Conclusions

Questions?

Thank you!

28 / 28