Example of using Xbus library to communicate with an MTi-1 series device using a full-duplex UART connection.

Dependencies:   mbed-rtos mbed Xbus

Fork of MTi-1_example by Alex Young

Important Information

This example is deprecated and no longer maintained. There are new embedded examples available in the MT SDK folder of the MT Software Suite. For more information please visit: https://xsenstechnologies.force.com/knowledgebase/s/article/Introduction-to-the-MT-SDK-programming-examples-for-MTi-devices

Overview

The example program demonstrates connecting to an MTi-1 series device, restoring communications settings to default if necessary, and configuring the MTi to send data. For an MTi-1 the device is configured to send inertial sensor data, while MTi-2 and MTi-3 devices are configured to output orientation data using the onboard XKF3i filter.

Communication with the MTi-1 series device is implemented using a either a full-duplex UART, I2C or SPI bus. A reset line is used to reset the MTi during initialization. Data is output to a host PC terminal using a second UART.

For more information on the MTi-1 series communication protocol please refer to the datasheet: https://www.xsens.com/download/pdf/documentation/mti-1/mti-1-series_datasheet.pdf

Supported Platforms

The program has been tested on the following mbed platforms:

Using the Example

  1. To use the example program connect one of the supported mbed boards to the host PC and download the application from the mbed online compiler to the target device.
  2. With the mbed board unpowered (USB disconnected) wire the mbed board to the MTi-1 development board. The following connections are required:
    • In all cases:
      • 5V (or 3V3) main supply to VDD (P300-1)
      • MCU IO voltage (IORef) to VDDIO (P300-2)
      • GND to GND (P300-3)
      • MT_NRESET to nRST (P300-5)
    • For I2C communication:
      • MT_SCL to I2C_SCL (P300-9)
      • MT_SDA to I2C_SDA (P300-11)
      • MT_DRDY to DRDY (P300-15)
      • MT_ADD0 to ADD0 (P300-17)
      • MT_ADD1 to ADD1 (P300-19)
      • MT_ADD2 to ADD2 (P300-21)
    • For SPI communication:
      • MT_DRDY to DRDY (P300-15)
      • MT_SCLK to SPI_SCK (P300-17)
      • MT_MISO to SPI_MISO (P300-19)
      • MT_MOSI to SPI_MOSI (P300-21)
      • MT_nCS to SPI_nCS (P300-23)
    • For UART communication:
      • MT_RX to UART_TX (P300-9)
      • MT_TX to UART_RX (P300-11)

For more information on the MTi-1 development board please refer to the MTi-1 series user manual: https://www.xsens.com/download/pdf/documentation/mti-1/mti-1-series_dk_user_manual.pdf

Information

Check the defines at the top of main.cpp to determine which IO pins are used for the MT_xxx connections on each mbed platform.

Information

The active peripheral (I2C, SPI or UART) is selected on the MTi-1 development board through the PSEL0 and PSEL1 switches. Look on the bottom of the development board for the correct settings.

  1. Connect to the target using a serial terminal. The application is configured for:
    • Baudrate = 921600
    • Stop bits = 1
    • No parity bits
    • No flow control
  2. Reset the mbed board.
  3. You should be presented with a simple user interface as shown below:
MTi-1 series embedded example firmware.
Device ready for operation.
Found device with ID: 03880011.
Device is an MTi-3: Attitude Heading Reference System.
Output configuration set to:
        Packet counter: 65535 Hz
        Sample time fine: 65535 Hz
        Quaternion: 100 Hz
        Status word: 65535 Hz

Press 'm' to start measuring and 'c' to return to config mode.
Committer:
Alex Young
Date:
Tue May 19 13:34:37 2015 +0200
Revision:
15:558d279addd9
Parent:
6:28cdd6ee6b9d
Make the MtData2_getItem function use XbusMessage struct

Who changed what in which revision?

UserRevisionLine numberNew contents of line
Alex Young 6:28cdd6ee6b9d 1 /*!
Alex Young 6:28cdd6ee6b9d 2 * \file
Alex Young 6:28cdd6ee6b9d 3 * \copyright
Alex Young 6:28cdd6ee6b9d 4 * Copyright (C) Xsens Technologies B.V., 2015. All rights reserved.
Alex Young 6:28cdd6ee6b9d 5 *
Alex Young 6:28cdd6ee6b9d 6 * This source code is intended for use only by Xsens Technologies BV and
Alex Young 6:28cdd6ee6b9d 7 * those that have explicit written permission to use it from
Alex Young 6:28cdd6ee6b9d 8 * Xsens Technologies BV.
Alex Young 6:28cdd6ee6b9d 9 *
Alex Young 6:28cdd6ee6b9d 10 * THIS CODE AND INFORMATION IS PROVIDED "AS IS" WITHOUT WARRANTY OF ANY
Alex Young 6:28cdd6ee6b9d 11 * KIND, EITHER EXPRESSED OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE
Alex Young 6:28cdd6ee6b9d 12 * IMPLIED WARRANTIES OF MERCHANTABILITY AND/OR FITNESS FOR A
Alex Young 6:28cdd6ee6b9d 13 * PARTICULAR PURPOSE.
Alex Young 6:28cdd6ee6b9d 14 */
Alex Young 6:28cdd6ee6b9d 15
Alex Young 6:28cdd6ee6b9d 16 #include "mtdata2.h"
Alex Young 6:28cdd6ee6b9d 17 #include <stddef.h>
Alex Young 6:28cdd6ee6b9d 18
Alex Young 6:28cdd6ee6b9d 19 static uint8_t const* getPointerToData(enum XsDataIdentifier id, uint8_t const* data, uint16_t dataLength)
Alex Young 6:28cdd6ee6b9d 20 {
Alex Young 6:28cdd6ee6b9d 21 uint8_t const* dptr = data;
Alex Young 6:28cdd6ee6b9d 22 while (dptr < data + dataLength)
Alex Young 6:28cdd6ee6b9d 23 {
Alex Young 6:28cdd6ee6b9d 24 const uint16_t itemId = (dptr[0] << 8) | dptr[1];
Alex Young 6:28cdd6ee6b9d 25 dptr += sizeof(itemId);
Alex Young 6:28cdd6ee6b9d 26 const uint8_t itemSize = *dptr++;
Alex Young 6:28cdd6ee6b9d 27
Alex Young 6:28cdd6ee6b9d 28 if (id == itemId)
Alex Young 6:28cdd6ee6b9d 29 return dptr;
Alex Young 6:28cdd6ee6b9d 30
Alex Young 6:28cdd6ee6b9d 31 dptr += itemSize;
Alex Young 6:28cdd6ee6b9d 32 }
Alex Young 6:28cdd6ee6b9d 33 return NULL;
Alex Young 6:28cdd6ee6b9d 34 }
Alex Young 6:28cdd6ee6b9d 35
Alex Young 6:28cdd6ee6b9d 36 static void readShort(uint16_t* out, uint8_t const* raw)
Alex Young 6:28cdd6ee6b9d 37 {
Alex Young 6:28cdd6ee6b9d 38 *out = (raw[0] << 8) | raw[1];
Alex Young 6:28cdd6ee6b9d 39 }
Alex Young 6:28cdd6ee6b9d 40
Alex Young 6:28cdd6ee6b9d 41 static void readInt(uint32_t* out, uint8_t const* raw)
Alex Young 6:28cdd6ee6b9d 42 {
Alex Young 6:28cdd6ee6b9d 43 *out = (raw[0] << 24) | (raw[1] << 16) | (raw[2] << 8) | raw[3];
Alex Young 6:28cdd6ee6b9d 44 }
Alex Young 6:28cdd6ee6b9d 45
Alex Young 6:28cdd6ee6b9d 46 static void readFloats(float* out, uint8_t const* raw, uint8_t floats)
Alex Young 6:28cdd6ee6b9d 47 {
Alex Young 6:28cdd6ee6b9d 48 for (int i = 0; i < floats; ++i)
Alex Young 6:28cdd6ee6b9d 49 {
Alex Young 6:28cdd6ee6b9d 50 readInt((uint32_t*)&out[i], &raw[i * sizeof(float)]);
Alex Young 6:28cdd6ee6b9d 51 }
Alex Young 6:28cdd6ee6b9d 52 }
Alex Young 6:28cdd6ee6b9d 53
Alex Young 15:558d279addd9 54 bool MtData2_getItem(void* item, enum XsDataIdentifier id, struct XbusMessage const* message)
Alex Young 6:28cdd6ee6b9d 55 {
Alex Young 15:558d279addd9 56 uint8_t const* raw = getPointerToData(id, message->data, message->length);
Alex Young 6:28cdd6ee6b9d 57 if (raw)
Alex Young 6:28cdd6ee6b9d 58 {
Alex Young 6:28cdd6ee6b9d 59 switch (id)
Alex Young 6:28cdd6ee6b9d 60 {
Alex Young 6:28cdd6ee6b9d 61 case XDI_PacketCounter:
Alex Young 6:28cdd6ee6b9d 62 readShort(item, raw);
Alex Young 6:28cdd6ee6b9d 63 break;
Alex Young 6:28cdd6ee6b9d 64
Alex Young 6:28cdd6ee6b9d 65 case XDI_SampleTimeFine:
Alex Young 6:28cdd6ee6b9d 66 case XDI_StatusWord:
Alex Young 6:28cdd6ee6b9d 67 readInt(item, raw);
Alex Young 6:28cdd6ee6b9d 68 break;
Alex Young 6:28cdd6ee6b9d 69
Alex Young 6:28cdd6ee6b9d 70 case XDI_Quaternion:
Alex Young 6:28cdd6ee6b9d 71 case XDI_DeltaQ:
Alex Young 6:28cdd6ee6b9d 72 readFloats(item, raw, 4);
Alex Young 6:28cdd6ee6b9d 73 break;
Alex Young 6:28cdd6ee6b9d 74
Alex Young 6:28cdd6ee6b9d 75 case XDI_DeltaV:
Alex Young 6:28cdd6ee6b9d 76 case XDI_Acceleration:
Alex Young 6:28cdd6ee6b9d 77 case XDI_RateOfTurn:
Alex Young 6:28cdd6ee6b9d 78 case XDI_MagneticField:
Alex Young 6:28cdd6ee6b9d 79 readFloats(item, raw, 3);
Alex Young 6:28cdd6ee6b9d 80 break;
Alex Young 6:28cdd6ee6b9d 81
Alex Young 6:28cdd6ee6b9d 82 default:
Alex Young 6:28cdd6ee6b9d 83 return false;
Alex Young 6:28cdd6ee6b9d 84 }
Alex Young 6:28cdd6ee6b9d 85 return true;
Alex Young 6:28cdd6ee6b9d 86 }
Alex Young 6:28cdd6ee6b9d 87 else
Alex Young 6:28cdd6ee6b9d 88 {
Alex Young 6:28cdd6ee6b9d 89 return false;
Alex Young 6:28cdd6ee6b9d 90 }
Alex Young 6:28cdd6ee6b9d 91 }
Alex Young 6:28cdd6ee6b9d 92