Difference between revisions of "RoboVero"

From Gumstix User Wiki
Jump to: navigation, search
(Usage)
(Workflow)
Line 571: Line 571:
 
|}
 
|}
  
=== Workflow ===
+
=== Recommended Workflow - Experts ===
 +
 
 +
Python can be used for developing your robotics applications quickly and interactively. If you get into a situation where the USB communication latency is hindering performance the easiest thing to do is port your code to C and add an entry to the driver function table. This is how the functions '''roboveroConfig''' and '''resetConfig''' were developed. This approach is also being used for the Arduino Compatibility Layer currently under development (some of which is you can find in arduino.py). If you think others might find your additions useful, you can even join the Robovero projects on github.
 +
 
 +
If you absolutely must use interrupts, there is no need to ditch the Python Client Library for a pure C firmware implementation. Simply write and test your interrupt service routine - you might be able to do so in python before porting to C - and then add it to the vector table in startup.c. Now, you can enable the interrupt through your python application and expect it to be handled with minimal latency.
  
 
=== Pitfalls ===
 
=== Pitfalls ===

Revision as of 15:43, 24 June 2011

RoboVero(tm) is a robotics expansion board for the Overo COM series.

Error creating thumbnail: Unable to save thumbnail to destination
RoboVero Expansion Board

Quickstart

Connect

All RoboVero boards ship with a peripheral driver library and command line interface preflashed. When you apply power, a red LED should illuminate immediately. This indicates that code is executing on the board. The LED stays on until a USB connection is established when it begins blinking at a heartbeat rhythm. The device should appear as /dev/ttyACM0. You can connect with kermit.

$ ls /dev | grep ttyACM
ttyACM0
$ kermit -l /dev/ttyACM0

C-Kermit 8.0.211, 10 Apr 2004, for Linux
 Copyright (C) 1985, 2004,
  Trustees of Columbia University in the City of New York.
Type ? or HELP for help.
C-Kermit> set carrier-watch off
C-Kermit> connect
<snip welcome message>
press enter to begin...

This gives you a simple command line interface to most of the NXP driver functions.


Hardware

Error creating thumbnail: Unable to save thumbnail to destination
HubCommander

All you need to get started with RoboVero is a power source - a 5-15V battery or 5V power supply will do - and USB-A to Mini-B cable. Note that the RoboVero power supply is different from that of other expansion boards.

RoboVero is based on the NXP LPC1769 ARM Cortex-M3 microcontroller. Schematic and layout are available here

HubCommander

When an external machine is connected to the RoboVero USB Mini-B, it automatically takes control of the RoboVero USB subsystem.


Toolchain

Prerequisites

You'll need to install git to retrieve some of the software for the toolchain.

$ sudo apt-get install gawk bison flex automake libtool libncurses5-dev zlib1g-dev libusb-dev unzip

Create a new folder in your home directory.

$ mkdir ${HOME}/cortex-m3

crosstool-NG

A cross compiler builds executable code for a platform other than the one on which the compiler runs. In our case, the toolchain (compiler, linker, debugger, etc.) will typically run on i386 or i686 and generate binaries for ARMv7-M. crosstool-NG is an application for building cross toolchains.

ARM Angstrom

Building the RoboVero toolchain for Overo takes hours and requires installing a number of non-standard packages. The easiest way to get started is to download the archive containing a pre-built toolchain and extract it to your home folder.

NOTE: This hasn't been tested with a clean build and may require additional packages.

# cd
# wget http://cumulus.gumstix.org/sources/robovero/x-tools.tar.gz
# tar -xzf x-tools.tar.gz

Your toolchain should appear in ${HOME}/x-tools. Process the the Exporting PATH section.


Other

Go to http://ymorin.is-a-geek.org/dokuwiki/projects/crosstool to determine the current version of crosstool-NG

$ cd ${HOME}/cortex-m3
$ wget http://ymorin.is-a-geek.org/download/crosstool-ng/crosstool-ng-X.X.X.tar.bz2

Extract the archive

$ tar xjf crosstool-ng-X.X.X.tar.bz2
$ cd ${HOME}/cortex-m3/crosstool-ng-X.X.X

Install crosstool-ng

$ ./configure
$ make
$ make install

Make a new directory for the baremetal configuration file.

$ mkdir ${HOME}/cortex-m3/arm-eabi
$ cd ${HOME}/cortex-m3/arm-eabi
$ cp ${HOME}/cortex-m3/crosstool-ng-1.9.1/samples/arm-bare_newlib_cortex_m3_nommu-eabi/crosstool.config .config

Add gdb to the configuration and build the toolchain. The build will take around 30 minutes depending on your machine.

$ ct-ng menuconfig
Debug facilities  ---
 [*] gdb  ---
  [*]   Cross-gdb
$ ct-ng build


Exporting PATH

If the build succeeds your new toolchain will appear in ~/x-tools. Add to the PATH environment variable (where the system looks for binaries) by appending an export command to .bashrc. Open a new terminal and echo path to verify that the change has taken effect.

$ nano ${HOME}/.bashrc
export PATH="${HOME}/x-tools/arm-bare_newlib_cortex_m3_nommu-eabi/bin:$PATH"
[new terminal]
$ echo $PATH


LPC1700CMSIS

LPC1700CMSIS is a collection of source code and libraries to simplify writing firmware for the M3.

$ cd ${HOME}/cortex-m3
$ mkdir LPC1700CMSIS
$ cd LPC1700CMSIS
$ wget

http://ics.nxp.com/support/documents/microcontrollers/zip/lpc17xx.cmsis.driver.library.zip

$ unzip lpc17xx.cmsis.driver.library.zip

Test

Time to find out whether we can compile a project. Let's try to build the LPC1700CMSIS Driver Library.

$ cd ${HOME}/cortex-m3/LPC1700CMSIS/makesection
$ nano makeconfig
PROJ_ROOT         =${HOME}/cortex-m3/LPC1700CMSIS
CMCORE_TYPE       =CM3
DEVICE            =LPC17xx
MANUFACTURE       =NXP
TOOL              =gnu
DEBUG_MODE        =1
GNU_INSTALL_ROOT  =${HOME}/x-tools/arm-bare_newlib_cortex_m3_nommu-eabi
GNU_VERSION       =4.4.1
$ cd makerule/common
$ nano make.rules.environment

[remove path and .exe extension from tools - you might also need to change some backslashes]

$ cd ../LPC17xx
$ nano makefile.LPC17xx.gnu
TOOLCHAIN =arm-bare_newlib_cortex_m3_nommu-eabi
$ ${HOME}/cortex-m3/LPC1700CMSIS
$ make VERBOSE=yes

Take a look at the compiler messages to verify that arm-bare_newlib_cortex_m3_nommu-eabi-gcc and arm-bare_newlib_cortex_m3_nommu-eabi-ld are being invoked. If so, and you get no build errors, the toolchain is working. You can also try building one of the images in the Examples folder.


FT2232

FT2232 is a serial protocol converter that provides JTAG connectivity to the Robovero and console port access to the Overo COM. We need to install the driver for JTAG to work.

Ubuntu

$ sudo apt-get install libftdi-dev


ARM Angstrom

# opkg install libftdi


Other

Go to http://www.intra2net.com/en/developer/libftdi/download.php to find the current libftdi release

$ cd ${HOME}/cortex-m3
$ wget http://www.intra2net.com/en/developer/libftdi/download/libftdi-X.X.tar.gz
$ tar xf libftdi-X.X.tar.gz
$ cd libftdi-X.XX/
$ ./configure
$ make
$ sudo make install
$ sudo ldconfig


OpenOCD

Open On-Circuit Debugger (OpenOCD) provides debugging, in-system programming and boundary-scan testing for the Robovero. It connects the debug host (your development machine) to the target (cortex) through an adapter (FT2232). OpenOCD allows you to debug code running on the target with GDB.

ARM Angstrom

# wget http://cumulus.gumstix.org/sources/robovero/openocd_0.4-r0.6_armv7a.ipk
# opkg install openocd_0.4-r0.6_armv7a.ipk
# wget http://cumulus.gumstix.org/sources/lpc1769.cfg
# cp lpc1769.cfg /usr/share/openocd/scripts/target


Other

$ cd ${HOME}/cortex-m3
$ wget http://download.berlios.de/openocd/openocd-X.X.X.tar.bz2
$ tar xjf openocd-X.X.X.tar.bz2
$ cd openocd-X.X.X/
$ ./configure --enable-ft2232_libftdi
$ make
$ sudo make install
$ wget http://cumulus.gumstix.org/sources/lpc1769.cfg
$ sudo cp lpc1769.cfg /usr/local/share/openocd/scripts/target


Test

Plug in your device. And run OpenOCD to connect.

$ sudo openocd -f interface/openocd-usb.cfg -f target/lpc1769.cfg
Open On-Chip Debugger 0.4.0 (2011-01-06-19:17)
Licensed under GNU GPL v2
For bug reports, read
    http://openocd.berlios.de/doc/doxygen/bugs.html
500 kHz
Info : clock speed 500 kHz
Info : JTAG tap: lpc1768.cpu tap/device found: 0x4ba00477 (mfg: 0x23b, part: 0xba00, ver: 0x4)
Info : lpc1768.cpu: hardware has 6 breakpoints, 4 watchpoints


Eclipse

First, install Eclipse and C/C++ Development Tooling. In Ubuntu,

sudo apt-get install eclipse eclipse-cdt

If you are using a different OS, go to Eclipse downloads for the correct version. The following instructions are for Eclipse Galileo.


INSTRUCTIONS

Firmware

Source

The source for the firmware that ships with RoboVero is available via github. Follow these steps if you would like to contribute to the project or just use it as a reference.

$ cd
$ mkdir robovero
$ cd robovero
$ git clone git://github.com/robovero/firmware.git

The source will now appear in ${HOME}/robovero/firmware. Next, build and flash the firmware to your device. If your toolchain isn't at ${HOME}/x-tools you will have to modify the Makefile and PATH environment variable.

$ cd firmware
$ make

Start OpenOCD according to the above instructions if you haven't already. Open another terminal. We will flash using GDB.

$ wget http://cumulus.gumstix.org/sources/robovero/gdbconfig
$ x-tools/arm-bare_newlib_cortex_m3_nommu-eabi/bin/arm-bare_newlib_cortex_m3_nommu-eabi-gdb -x gdbconfig robovero/firmware/firmware
(gdb) load
(gdb) continue

If your LED starts to flash then your debug tools are working. You can press the RoboVero reset and the firmware will run without GDB.


Functions

list

You can call list to see all available functions.

[:)] list
<snip all functions>

Or for a more manageable subset, provide a start and the number of functions to display. Note that all arguments and return values are hexadecimal.

[:)] list 1 7
001 return
002 search
003 list
004 promptOn
005 promptOff
006 heartbeatOn
007 heartbeatOff
008 malloc
009 free
00a deref
00b roboveroConfig
00c resetConfig

The number beside the function name is its index in the function list. You can speed up function calls by using the index rather than the function name.

[:)] 3 1 c
001 return
002 search
003 list
004 promptOn
005 promptOff
006 heartbeatOn
007 heartbeatOff
008 malloc
009 free
00a deref
00b roboveroConfig
00c resetConfig


return

Your prompt indicates whether the previous operation succeeded.

[:)] somenonfunction
[:(] 

Naturely, it is best to avoid upsetting RoboVero whenever possible. return is another mechanism for obtaining the return status.

[:)] return
0
[:)] somenonfunction
[:(] return
1
[:)] 

There are a couple of subtle points to understand here. First, return indicates the status of the command line, not of the function you are calling. For example, the function I2C_MasterTransferData might fail to transfer data on the I2C bus, and return will output 0 since the command line operation succeeded - the function was called. The second point is that return modifies the status variable. If you call a function that fails, and then accidentally call retrun the status of the previous operation is lost.


search

If you want to find the index of a function you can use search to find it.

[:)] search GPIO_SetValue
261 GPIO_SetValue

If you don't know the full name of the function you can search part of it.

[:)] search GPIO
24c GPIO_ClearInt
24d GPIO_GetIntStatus
24f GPIO_IntCmd
252 GPIO_ReadValue
25a GPIO_ClearValue
261 GPIO_SetValue
263 GPIO_SetDir
264 GPIO_Byte_TypeDef_malloc
265 GPIO_HalfWord_TypeDef_malloc
266 GPIO_HalfWord_TypeDef_FIODIRL
267 GPIO_HalfWord_TypeDef_FIODIRU
268 GPIO_HalfWord_TypeDef_FIOMASKL
269 GPIO_HalfWord_TypeDef_FIOMASKU
26a GPIO_HalfWord_TypeDef_FIOPINL
26b GPIO_HalfWord_TypeDef_FIOPINU
26c GPIO_HalfWord_TypeDef_FIOSETL
26d GPIO_HalfWord_TypeDef_FIOSETU
26e GPIO_HalfWord_TypeDef_FIOCLRL
26f GPIO_HalfWord_TypeDef_FIOCLRU

If you attempt to call a function that isn't found, search is called automatically.

[:)] GPIO_ClearIn
24c GPIO_ClearInt


promptOn/promptOff

These functions are used to enable/disable local echo and the command prompt. These are used by the Python Client Library. You will probably not use them unless you are writing your own interface for RoboVero (in C, bash, etc.).

[:)] promptOff
<types promptOn>
[:)]


heartbeatOn/heartbeatOff

If you want to disable the default heartbeat rhythm of the LED call heartbeatOff.


malloc

malloc allows you to allocate space in RoboVero RAM for data. The following command requests 16 bytes of memory and a pointer to heap space where the memory is allocated is returned.

[:)] malloc 10
10003900


free

Release a block of previously allocated memory back to the heap.

[:)] free 10003900


deref

Read or write the value stored at a given address. The first argument is the memory address, the second is the width (number of bytes) the value uses. If a third argument is provided the value is written, otherwise it is read.

[:)] malloc 4
10003900
[:)] deref 10003900 1
72
[:)] deref 10003900 2
4472
[:)] deref 10003900 4
a2094472
[:)] deref 10003900 4 0
[:)] deref 10003900 4
0
[:)] free 10003900

deref does not validate the memory address provided so you must exercise caution when using this function. A mistyped address could easily lead to a system fault requiring a reset.


roboveroConfig

roboveroConfig exists for users that want to quickly get using the RoboVero in its standard configuration. It automatically configures the pins according to their PCB labels and initializes peripherals. The intent is to reduce the overhead associated with using RoboVero. roboveroConfig is used in a number of the Python Client Library examples.


resetConfig

This is a convenience/safety function that simulates the effect of a reset on pin select registers without disconnecting USB. resetConfig is called automatically when a Python Client Library program terminates.


Library functions

A second group of functions wrap the LPC17xx CMSIS-Compliant Standard Peripheral Firmware Driver Library functions. Pass arguments to these functions as hexadecimal values and expect the same returned. For example, GPIO_SetValue and GPIO_ClearValue can be used to manually control the LED. First we need to disable the heartbeat.

[:)] heartbeatOff

Now we can turn the LED on. Since P3.25 controls the LED's cathode, we need to drive the pin low.

[:)] GPIO_ClearValue 3 2000000

This is equivalent to the following function call in C, which is used in the heartbeat function.

GPIO_ClearValue(3, (1<<25));

The command line interface does not resolve mathematical operations such as (1<<25) so anything beyond simple testing quickly becomes cumbersome using the command line. However, it is relatively simple to write a script that makes a series of function calls. This is precisely what the Python Client Library does, and a similar interface can be written in any language that supports serial communication.

If you followed the installation above, you can find documentation for library functions in ${HOME}/cortex-m3/LPC1700CMSIS.


Data functions

A final category of function is used for safely manipulating data structures used by the peripheral driver library. Here is the definition of PINSEL_CFG_Type:

typedef struct
{
    uint8_t Portnum;    /* Port Number: 0 to 4 */
    uint8_t Pinnum;     /* Pin Number: 0 to 31 */
    uint8_t Funcnum;    /* Function Number: 0 to 3 */
    uint8_t Pinmode;    /* Pin Mode: 0 (Internal pull-up resistor), 2 (Tri-state), 3 (Internal pull-down resistor) */
    uint8_t OpenDrain;  /* OpenDrain mode: 0 (Normal mode), 1 (Open drain mode) */
} PINSEL_CFG_Type;

Now let's search PINSEL_CFG_Type.

[:)] PINSEL_CFG_Type
273 PINSEL_CFG_Type_malloc
274 PINSEL_CFG_Type_Portnum
275 PINSEL_CFG_Type_Pinnum
276 PINSEL_CFG_Type_Funcnum
277 PINSEL_CFG_Type_Pinmode
278 PINSEL_CFG_Type_OpenDrain

Using these functions you can allocate space in RoboVero RAM for a PINSEL_CFG_Type struct and access member values. This is how you can use PINSEL_CFG_Type functions to set up I2C communications for the accelerometer, compass, and gyroscope.

[:)] PINSEL_CFG_Type_malloc
10003900
[:)] PINSEL_CFG_Type_Portnum 10003900 0
[:)] PINSEL_CFG_Type_Pinnum 10003900 1B
[:)] PINSEL_CFG_Type_Pinmode 10003900 0
[:)] PINSEL_CFG_Type_OpenDrain 10003900 0
[:)] PINSEL_CFG_Type_Funcnum 10003900 1
[:)] PINSEL_ConfigPin 10003900
[:)] PINSEL_CFG_Type_Pinnum 10003900 1C
[:)] PINSEL_ConfigPin 10003900

Now for the sake of the exercise we can read some member values.

[:)] PINSEL_CFG_Type_Pinnum 10003900
1C
[:)] PINSEL_CFG_Type_OpenDrain 10003900
0

And then free the memory where the struct was stored.

[:)] free 10003900

Note that this is all done for you if you call roboveroConfig.


Interrupts

Interrupts are currently unimplement. Enabling an interrupt will most likely lead to very bad things.


Software

As demonstrated in the firmware section, it is possible to control RoboVero with a simple serial terminal application. However, for anything but the simplest of tasks, this can quickly become unwieldy. The solution is a language interface that allows RoboVero functions to be called from within a program. One such API is the RoboVero Python Client Library. Python has a comprehensive standard library and online documentation making it an accessible and powerful language for robotics applications.

Source

The Python Client Library is available via github.

$ cd ~/robovero
$ git clone git://github.com/robovero/python.git


Examples

The easiest way to get started with the Python Client Library is to try some of the included examples. Make sure that your RoboVero is powered, USB is connected, and the device has been reset (see pitfalls).

$ cd ~/robovero/python

This examples measures a voltage on AD0_0.

$ python adc.py
1748
756
883
749
795
^C
keyboard interrupt: how rude!

This example displays x, y, and z readings for the on-board accelerometer, compass, and gyro.

$ python IMU.py 
a [x, y, z]:  [-880, -640, -16704]
c [x, y, z]:  [-257, -257, -257]
g [x, y, z]:  [-257, -257, -257]

a [x, y, z]:  [-832, -608, -16672]
c [x, y, z]:  [-257, -257, -257]
g [x, y, z]:  [-257, -257, -257]

^CTraceback (most recent call last):
  File "IMU.py", line 130, in <module>
    time.sleep(1)
KeyboardInterrupt

This example requires an RC servo connected to PWM1.

New angle: 10 
New angle: 100
enter an angle between 0 and 90 degrees
New angle: 20
New angle: 0
New angle: ^CTraceback (most recent call last):
  File "servo.py", line 65, in <module>
    match_value = getServoAngle()
  File "servo.py", line 22, in getServoAngle
    user_angle = raw_input("New angle: ")
KeyboardInterrupt


Usage

The biggest difference between using the C peripheral drivers and the client library is the way that data is handled. Structs in C are treated as classes in Python. The table below outlines the usage differences for PINSEL_CFG_Type.

C Python
Declaration PINSEL_CFG_Type PinCfg; PinCfg = PINSEL_CFG_Type()
Referencing PINSEL_ConfigPin(&PinCfg); PINSEL_ConfigPin(PinCfg.ptr)

Recommended Workflow - Experts

Python can be used for developing your robotics applications quickly and interactively. If you get into a situation where the USB communication latency is hindering performance the easiest thing to do is port your code to C and add an entry to the driver function table. This is how the functions roboveroConfig and resetConfig were developed. This approach is also being used for the Arduino Compatibility Layer currently under development (some of which is you can find in arduino.py). If you think others might find your additions useful, you can even join the Robovero projects on github.

If you absolutely must use interrupts, there is no need to ditch the Python Client Library for a pure C firmware implementation. Simply write and test your interrupt service routine - you might be able to do so in python before porting to C - and then add it to the vector table in startup.c. Now, you can enable the interrupt through your python application and expect it to be handled with minimal latency.

Pitfalls

  • When you first connect to RoboVero it asks you to press enter to begin. This is used to detect the line termination that your host machine is using - whether it be an Overo COM, desktop PC, etc. It is possible that PCL sends different line terminators than your favorite serial application (Kermit, Minicom, etc.). If such is the case, you will have to perform a hard reset when switching from Kermit to your program or vice-versa.
  • The API currently only looks for '/dev/ttyACM0'. If your RoboVero appears under a different name, or you are porting to Windows, you will have to manually change this string in internals.py.