mirror of
https://github.com/eclipse/upm.git
synced 2025-03-15 04:57:30 +03:00
curieimu: Plugin to interface with the arduino101's IMU
Internal sensor onboard the Curie/Arduino101 can be accessed via Firmata using this plugin. You will need mraa compiled with -DFIRMATA=ON for this to work and be using Firmata with the CurieIMU firmata extension for ExtensibleFirmata Signed-off-by: Ron Evans <ron@hybridgroup.com> Signed-off-by: Justin Zemlyansky <jlstigman@live.com> Signed-off-by: Brendan Le Foll <brendan.le.foll@intel.com>
This commit is contained in:
parent
1aa445b74e
commit
224a915538
@ -240,6 +240,7 @@ add_example (rhusb)
|
||||
add_example (apds9930)
|
||||
add_example (kxcjk1013)
|
||||
add_example (ssd1351)
|
||||
add_example (curieimu)
|
||||
|
||||
# These are special cases where you specify example binary, source file and module(s)
|
||||
include_directories (${PROJECT_SOURCE_DIR}/src)
|
||||
|
70
examples/c++/curieimu.cxx
Normal file
70
examples/c++/curieimu.cxx
Normal file
@ -0,0 +1,70 @@
|
||||
/*
|
||||
* Author: Brendan Le Foll <brendan.le.foll@intel.com>
|
||||
* Author: Ron Evans (@deadprogram)
|
||||
* Author: Justin Zemlyansky (@JustInDevelopment)
|
||||
* Copyright (c) 2016 Intel Corporation.
|
||||
*
|
||||
* Permission is hereby granted, free of charge, to any person obtaining
|
||||
* a copy of this software and associated documentation files (the
|
||||
* "Software"), to deal in the Software without restriction, including
|
||||
* without limitation the rights to use, copy, modify, merge, publish,
|
||||
* distribute, sublicense, and/or sell copies of the Software, and to
|
||||
* permit persons to whom the Software is furnished to do so, subject to
|
||||
* the following conditions:
|
||||
*
|
||||
* The above copyright notice and this permission notice shall be
|
||||
* included in all copies or substantial portions of the Software.
|
||||
*
|
||||
* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
|
||||
* EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
|
||||
* MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
|
||||
* NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE
|
||||
* LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION
|
||||
* OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION
|
||||
* WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
|
||||
*/
|
||||
|
||||
#include <unistd.h>
|
||||
#include <iostream>
|
||||
#include "curieimu.hpp"
|
||||
#include "mraa.h"
|
||||
#include "mraa/firmata.h"
|
||||
#include <math.h>
|
||||
|
||||
int
|
||||
main(int argc, char **argv)
|
||||
{
|
||||
//! [Interesting]
|
||||
mraa_init();
|
||||
mraa_add_subplatform(MRAA_GENERIC_FIRMATA, "/dev/ttyACM0");
|
||||
|
||||
upm::CurieImu* sensor = new upm::CurieImu();
|
||||
|
||||
std::cout << "temperature is: " << (sensor->getTemperature() * pow(0.5, 9) + 23) << std::endl;
|
||||
|
||||
int x, y, z;
|
||||
sensor->readAccelerometer(&x, &y, &z);
|
||||
printf("accelerometer is: %d, %d, %d\n", x, y, z);
|
||||
|
||||
int a, b, c;
|
||||
sensor->readGyro(&a, &b, &c);
|
||||
printf("gyroscope is: %d, %d, %d\n", a, b, c);
|
||||
|
||||
int axis, direction;
|
||||
sensor->enableShockDetection(true);
|
||||
for(int i=0; i<300; i++) {
|
||||
if (sensor->isShockDetected()) {
|
||||
sensor->getShockDetectData(&axis, &direction);
|
||||
printf("shock data is: %d, %d\n", axis, direction);
|
||||
}
|
||||
usleep(10000);
|
||||
}
|
||||
|
||||
int m, n, o, p, q, r;
|
||||
sensor->readMotion(&m, &n, &o, &p, &q, &r);
|
||||
printf("motion is: %d, %d, %d, %d, %d, %d\n", m, n, o, p, q, r);
|
||||
|
||||
delete sensor;
|
||||
|
||||
return 0;
|
||||
}
|
5
src/curieimu/CMakeLists.txt
Normal file
5
src/curieimu/CMakeLists.txt
Normal file
@ -0,0 +1,5 @@
|
||||
set (libname "curieimu")
|
||||
set (libdescription "upm Curie IMU via Firmata")
|
||||
set (module_src ${libname}.cpp)
|
||||
set (module_h ${libname}.hpp)
|
||||
upm_module_init()
|
384
src/curieimu/curieimu.cpp
Normal file
384
src/curieimu/curieimu.cpp
Normal file
@ -0,0 +1,384 @@
|
||||
/*
|
||||
* Author: Brendan Le Foll <brendan.le.foll@intel.com>
|
||||
* Author: Ron Evans (@deadprogram)
|
||||
* Author: Justin Zemlyansky (@JustInDevelopment)
|
||||
* Copyright (c) 2016 Intel Corporation.
|
||||
*
|
||||
* Permission is hereby granted, free of charge, to any person obtaining
|
||||
* a copy of this software and associated documentation files (the
|
||||
* "Software"), to deal in the Software without restriction, including
|
||||
* without limitation the rights to use, copy, modify, merge, publish,
|
||||
* distribute, sublicense, and/or sell copies of the Software, and to
|
||||
* permit persons to whom the Software is furnished to do so, subject to
|
||||
* the following conditions:
|
||||
*
|
||||
* The above copyright notice and this permission notice shall be
|
||||
* included in all copies or substantial portions of the Software.
|
||||
*
|
||||
* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
|
||||
* EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
|
||||
* MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
|
||||
* NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE
|
||||
* LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION
|
||||
* OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION
|
||||
* WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
|
||||
*/
|
||||
|
||||
#include <iostream>
|
||||
#include <string>
|
||||
#include <string.h>
|
||||
#include <stdexcept>
|
||||
#include <unistd.h>
|
||||
#include <stdlib.h>
|
||||
#include <pthread.h>
|
||||
|
||||
#include "curieimu.hpp"
|
||||
|
||||
using namespace upm;
|
||||
|
||||
static CurieImu* awaitingReponse;
|
||||
|
||||
CurieImu::CurieImu (int subplatformoffset)
|
||||
{
|
||||
m_firmata = mraa_firmata_init(FIRMATA_CURIE_IMU);
|
||||
if (m_firmata == NULL) {
|
||||
throw std::invalid_argument(std::string(__FUNCTION__) +
|
||||
": mraa_firmata_init() failed");
|
||||
return;
|
||||
}
|
||||
|
||||
if (pthread_mutex_init(&m_responseLock, NULL)) {
|
||||
throw std::runtime_error(std::string(__FUNCTION__) +
|
||||
": pthread_mutex_init(m_responseLock) failed");
|
||||
return;
|
||||
}
|
||||
|
||||
if (pthread_cond_init(&m_responseCond, NULL)) {
|
||||
throw std::runtime_error(std::string(__FUNCTION__) +
|
||||
": pthread_cond_init(m_responseCond) failed");
|
||||
return;
|
||||
}
|
||||
}
|
||||
|
||||
CurieImu::~CurieImu()
|
||||
{
|
||||
pthread_mutex_destroy(&m_responseLock);
|
||||
pthread_cond_destroy(&m_responseCond);
|
||||
}
|
||||
|
||||
void
|
||||
CurieImu::lock()
|
||||
{
|
||||
pthread_mutex_lock(&m_responseLock);
|
||||
}
|
||||
|
||||
void
|
||||
CurieImu::unlock()
|
||||
{
|
||||
pthread_mutex_unlock(&m_responseLock);
|
||||
}
|
||||
|
||||
void
|
||||
CurieImu::waitForResponse()
|
||||
{
|
||||
awaitingReponse = this;
|
||||
pthread_cond_wait(&m_responseCond, &m_responseLock);
|
||||
}
|
||||
|
||||
void
|
||||
CurieImu::proceed()
|
||||
{
|
||||
pthread_cond_broadcast(&m_responseCond);
|
||||
}
|
||||
|
||||
void
|
||||
CurieImu::setResults(uint8_t* buf, int length)
|
||||
{
|
||||
m_results = new char(length);
|
||||
memcpy((void*)m_results, (void*)buf, length);
|
||||
}
|
||||
|
||||
/*
|
||||
* Handles a single syncronous response being returned from Firmata
|
||||
*
|
||||
* @param buffer the data beinig returned from Firmata
|
||||
* @param length length of results buffer
|
||||
*/
|
||||
static void
|
||||
handleSyncResponse(uint8_t* buf, int length)
|
||||
{
|
||||
awaitingReponse->setResults(buf, length);
|
||||
awaitingReponse->proceed();
|
||||
}
|
||||
|
||||
/*
|
||||
* Handles asyncronous responses being returned from Firmata
|
||||
*
|
||||
* @param buffer the data beinig returned from Firmata
|
||||
* @param length length of results buffer
|
||||
*/
|
||||
static void
|
||||
handleAsyncResponses(uint8_t* buf, int length)
|
||||
{
|
||||
awaitingReponse->setResults(buf, length);
|
||||
awaitingReponse->processResponse();
|
||||
}
|
||||
|
||||
void
|
||||
CurieImu::processResponse()
|
||||
{
|
||||
switch(m_results[2]) {
|
||||
case FIRMATA_CURIE_IMU_SHOCK_DETECT:
|
||||
{
|
||||
IMUDataItem* item = new IMUDataItem();
|
||||
item->axis = m_results[3];
|
||||
item->direction = m_results[4];
|
||||
m_shockData.push(item);
|
||||
break;
|
||||
}
|
||||
case FIRMATA_CURIE_IMU_STEP_COUNTER:
|
||||
{
|
||||
int count = ((m_results[3] & 0x7f) | ((m_results[4] & 0x7f) << 7));
|
||||
m_stepData.push(count);
|
||||
break;
|
||||
}
|
||||
case FIRMATA_CURIE_IMU_TAP_DETECT:
|
||||
{
|
||||
IMUDataItem* item = new IMUDataItem();
|
||||
item->axis = m_results[3];
|
||||
item->direction = m_results[4];
|
||||
m_tapData.push(item);
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
return;
|
||||
}
|
||||
|
||||
void
|
||||
CurieImu::readAccelerometer(int *xVal, int *yVal, int *zVal)
|
||||
{
|
||||
char message[4];
|
||||
message[0] = FIRMATA_START_SYSEX;
|
||||
message[1] = FIRMATA_CURIE_IMU;
|
||||
message[2] = FIRMATA_CURIE_IMU_READ_ACCEL;
|
||||
message[3] = FIRMATA_END_SYSEX;
|
||||
|
||||
lock();
|
||||
|
||||
mraa_firmata_response_stop(m_firmata);
|
||||
mraa_firmata_response(m_firmata, handleSyncResponse);
|
||||
mraa_firmata_write_sysex(m_firmata, &message[0], 4);
|
||||
|
||||
waitForResponse();
|
||||
|
||||
*xVal = ((m_results[3] & 0x7f) | ((m_results[4] & 0x7f) << 7));
|
||||
*yVal = ((m_results[5] & 0x7f) | ((m_results[6] & 0x7f) << 7));
|
||||
*zVal = ((m_results[7] & 0x7f) | ((m_results[8] & 0x7f) << 7));
|
||||
|
||||
delete m_results;
|
||||
unlock();
|
||||
|
||||
return;
|
||||
}
|
||||
|
||||
void
|
||||
CurieImu::readGyro(int *xVal, int *yVal, int *zVal)
|
||||
{
|
||||
char message[4];
|
||||
message[0] = FIRMATA_START_SYSEX;
|
||||
message[1] = FIRMATA_CURIE_IMU;
|
||||
message[2] = FIRMATA_CURIE_IMU_READ_GYRO;
|
||||
message[3] = FIRMATA_END_SYSEX;
|
||||
|
||||
lock();
|
||||
|
||||
mraa_firmata_response_stop(m_firmata);
|
||||
mraa_firmata_response(m_firmata, handleSyncResponse);
|
||||
mraa_firmata_write_sysex(m_firmata, &message[0], 4);
|
||||
|
||||
waitForResponse();
|
||||
|
||||
*xVal = ((m_results[3] & 0x7f) | ((m_results[4] & 0x7f) << 7));
|
||||
*yVal = ((m_results[5] & 0x7f) | ((m_results[6] & 0x7f) << 7));
|
||||
*zVal = ((m_results[7] & 0x7f) | ((m_results[8] & 0x7f) << 7));
|
||||
|
||||
delete m_results;
|
||||
unlock();
|
||||
|
||||
return;
|
||||
}
|
||||
|
||||
int16_t
|
||||
CurieImu::getTemperature()
|
||||
{
|
||||
char message[4];
|
||||
message[0] = FIRMATA_START_SYSEX;
|
||||
message[1] = FIRMATA_CURIE_IMU;
|
||||
message[2] = FIRMATA_CURIE_IMU_READ_TEMP;
|
||||
message[3] = FIRMATA_END_SYSEX;
|
||||
|
||||
lock();
|
||||
|
||||
mraa_firmata_response_stop(m_firmata);
|
||||
mraa_firmata_response(m_firmata, handleSyncResponse);
|
||||
mraa_firmata_write_sysex(m_firmata, &message[0], 4);
|
||||
|
||||
waitForResponse();
|
||||
|
||||
int16_t result;
|
||||
result = ((m_results[3] & 0x7f) | ((m_results[4] & 0x7f) << 7));
|
||||
result += ((m_results[5] & 0x7f) | ((m_results[6] & 0x7f) << 7)) << 8;
|
||||
|
||||
delete m_results;
|
||||
unlock();
|
||||
|
||||
return result;
|
||||
}
|
||||
|
||||
void
|
||||
CurieImu::readMotion(int *xA, int *yA, int *zA, int *xG, int *yG, int *zG)
|
||||
{
|
||||
char message[4];
|
||||
message[0] = FIRMATA_START_SYSEX;
|
||||
message[1] = FIRMATA_CURIE_IMU;
|
||||
message[2] = FIRMATA_CURIE_IMU_READ_MOTION;
|
||||
message[3] = FIRMATA_END_SYSEX;
|
||||
|
||||
lock();
|
||||
|
||||
mraa_firmata_response_stop(m_firmata);
|
||||
mraa_firmata_response(m_firmata, handleSyncResponse);
|
||||
mraa_firmata_write_sysex(m_firmata, &message[0], 4);
|
||||
|
||||
waitForResponse();
|
||||
|
||||
*xA = ((m_results[3] & 0x7f) | ((m_results[4] & 0x7f) << 7));
|
||||
*yA = ((m_results[5] & 0x7f) | ((m_results[6] & 0x7f) << 7));
|
||||
*zA = ((m_results[7] & 0x7f) | ((m_results[8] & 0x7f) << 7));
|
||||
*xG = ((m_results[9] & 0x7f) | ((m_results[10] & 0x7f) << 7));
|
||||
*yG = ((m_results[11] & 0x7f) | ((m_results[12] & 0x7f) << 7));
|
||||
*zG = ((m_results[13] & 0x7f) | ((m_results[13] & 0x7f) << 7));
|
||||
|
||||
delete m_results;
|
||||
unlock();
|
||||
|
||||
return;
|
||||
}
|
||||
|
||||
void
|
||||
CurieImu::enableShockDetection(bool enable)
|
||||
{
|
||||
char message[5];
|
||||
message[0] = FIRMATA_START_SYSEX;
|
||||
message[1] = FIRMATA_CURIE_IMU;
|
||||
message[2] = FIRMATA_CURIE_IMU_SHOCK_DETECT;
|
||||
message[3] = enable;
|
||||
message[4] = FIRMATA_END_SYSEX;
|
||||
|
||||
lock();
|
||||
|
||||
mraa_firmata_response_stop(m_firmata);
|
||||
mraa_firmata_response(m_firmata, handleAsyncResponses);
|
||||
mraa_firmata_write_sysex(m_firmata, &message[0], 5);
|
||||
|
||||
awaitingReponse = this;
|
||||
unlock();
|
||||
|
||||
return;
|
||||
}
|
||||
|
||||
bool
|
||||
CurieImu::isShockDetected()
|
||||
{
|
||||
return (m_shockData.size() > 0);
|
||||
}
|
||||
|
||||
void
|
||||
CurieImu::getShockDetectData(int *axis, int *direction)
|
||||
{
|
||||
if (m_shockData.size() > 0) {
|
||||
IMUDataItem* item = m_shockData.front();
|
||||
*axis = item->axis;
|
||||
*direction = item->direction;
|
||||
m_shockData.pop();
|
||||
delete item;
|
||||
}
|
||||
}
|
||||
|
||||
void
|
||||
CurieImu::enableStepCounter(bool enable)
|
||||
{
|
||||
char message[5];
|
||||
message[0] = FIRMATA_START_SYSEX;
|
||||
message[1] = FIRMATA_CURIE_IMU;
|
||||
message[2] = FIRMATA_CURIE_IMU_STEP_COUNTER;
|
||||
message[3] = enable;
|
||||
message[4] = FIRMATA_END_SYSEX;
|
||||
|
||||
lock();
|
||||
|
||||
mraa_firmata_response_stop(m_firmata);
|
||||
mraa_firmata_response(m_firmata, handleAsyncResponses);
|
||||
mraa_firmata_write_sysex(m_firmata, &message[0], 5);
|
||||
|
||||
awaitingReponse = this;
|
||||
unlock();
|
||||
|
||||
return;
|
||||
}
|
||||
|
||||
bool
|
||||
CurieImu::isStepDetected()
|
||||
{
|
||||
return (m_stepData.size() > 0);
|
||||
}
|
||||
|
||||
void
|
||||
CurieImu::getStepCount(int *count)
|
||||
{
|
||||
if (m_stepData.size() > 0) {
|
||||
*count = m_stepData.front();
|
||||
m_stepData.pop();
|
||||
}
|
||||
}
|
||||
|
||||
void
|
||||
CurieImu::enableTapDetection(bool enable)
|
||||
{
|
||||
char message[5];
|
||||
message[0] = FIRMATA_START_SYSEX;
|
||||
message[1] = FIRMATA_CURIE_IMU;
|
||||
message[2] = FIRMATA_CURIE_IMU_TAP_DETECT;
|
||||
message[3] = enable;
|
||||
message[4] = FIRMATA_END_SYSEX;
|
||||
|
||||
lock();
|
||||
|
||||
mraa_firmata_response_stop(m_firmata);
|
||||
mraa_firmata_response(m_firmata, handleAsyncResponses);
|
||||
mraa_firmata_write_sysex(m_firmata, &message[0], 5);
|
||||
|
||||
awaitingReponse = this;
|
||||
unlock();
|
||||
|
||||
return;
|
||||
}
|
||||
|
||||
bool
|
||||
CurieImu::isTapDetected()
|
||||
{
|
||||
return (m_tapData.size() > 0);
|
||||
}
|
||||
|
||||
void
|
||||
CurieImu::getTapDetectData(int *axis, int *direction)
|
||||
{
|
||||
if (m_tapData.size() > 0) {
|
||||
IMUDataItem* item = m_tapData.front();
|
||||
*axis = item->axis;
|
||||
*direction = item->direction;
|
||||
m_tapData.pop();
|
||||
delete item;
|
||||
}
|
||||
}
|
235
src/curieimu/curieimu.hpp
Normal file
235
src/curieimu/curieimu.hpp
Normal file
@ -0,0 +1,235 @@
|
||||
/*
|
||||
* Author: Brendan Le Foll <brendan.le.foll@intel.com>
|
||||
* Author: Ron Evans (@deadprogram)
|
||||
* Author: Justin Zemlyansky (@JustInDevelopment)
|
||||
* Copyright (c) 2016 Intel Corporation.
|
||||
*
|
||||
* Permission is hereby granted, free of charge, to any person obtaining
|
||||
* a copy of this software and associated documentation files (the
|
||||
* "Software"), to deal in the Software without restriction, including
|
||||
* without limitation the rights to use, copy, modify, merge, publish,
|
||||
* distribute, sublicense, and/or sell copies of the Software, and to
|
||||
* permit persons to whom the Software is furnished to do so, subject to
|
||||
* the following conditions:
|
||||
*
|
||||
* The above copyright notice and this permission notice shall be
|
||||
* included in all copies or substantial portions of the Software.
|
||||
*
|
||||
* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
|
||||
* EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
|
||||
* MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
|
||||
* NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE
|
||||
* LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION
|
||||
* OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION
|
||||
* WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
|
||||
*/
|
||||
#pragma once
|
||||
|
||||
#include <mraa/firmata.h>
|
||||
#include <queue>
|
||||
|
||||
namespace upm {
|
||||
|
||||
/**
|
||||
* @brief CurieIMU sensor for Genuino 101 running Firmata
|
||||
* @defgroup curieimu libupm-curieimu
|
||||
* @ingroup firmata
|
||||
*/
|
||||
|
||||
/**
|
||||
* @library curieimu
|
||||
* @sensor curieimu
|
||||
* @comname Curie IMU sensor over Genuino 101 running Firmata
|
||||
* @altname Curie Firmata IMU
|
||||
* @type firmata
|
||||
* @man firmata imu genuino
|
||||
* @con firmata
|
||||
*
|
||||
* @brief API for the Curie IMU via Firmata
|
||||
*
|
||||
* Curie IMU is a 6-axxis acclerometer
|
||||
*
|
||||
* This module has been tested on an Genuino 101 running ConfigurableFirmata with CurieIMU
|
||||
*
|
||||
* @snippet curieimu.cxx Interesting
|
||||
*/
|
||||
|
||||
#define FIRMATA_START_SYSEX 0xF0
|
||||
#define FIRMATA_END_SYSEX 0xF7
|
||||
#define FIRMATA_CURIE_IMU 0x11
|
||||
#define FIRMATA_CURIE_IMU_READ_ACCEL 0x00
|
||||
#define FIRMATA_CURIE_IMU_READ_GYRO 0x01
|
||||
#define FIRMATA_CURIE_IMU_READ_TEMP 0x02
|
||||
#define FIRMATA_CURIE_IMU_SHOCK_DETECT 0x03
|
||||
#define FIRMATA_CURIE_IMU_STEP_COUNTER 0x04
|
||||
#define FIRMATA_CURIE_IMU_TAP_DETECT 0x05
|
||||
#define FIRMATA_CURIE_IMU_READ_MOTION 0x06
|
||||
|
||||
struct IMUDataItem {
|
||||
int axis;
|
||||
int direction;
|
||||
};
|
||||
|
||||
class CurieImu {
|
||||
public:
|
||||
|
||||
/**
|
||||
* Instantiates a CurieImu object
|
||||
*
|
||||
* @param subplatformoffset Subplatform offset
|
||||
*/
|
||||
CurieImu (int subplatform_offset=512);
|
||||
|
||||
/**
|
||||
* Destructor for CurieImu object
|
||||
*/
|
||||
~CurieImu();
|
||||
|
||||
/**
|
||||
* Read accelerometer X, Y, and Z axis
|
||||
*
|
||||
* @param xVal Pointer to returned X-axis value
|
||||
* @param yVal Pointer to returned Y-axis value
|
||||
* @param zVal Pointer to returned Z-axis value
|
||||
*/
|
||||
void readAccelerometer(int *xVal, int *yVal, int *zVal);
|
||||
|
||||
/**
|
||||
* Read gyroscope X, Y, and Z axis
|
||||
*
|
||||
* @param xVal Pointer to returned X-axis value
|
||||
* @param yVal Pointer to returned Y-axis value
|
||||
* @param zVal Pointer to returned Z-axis value
|
||||
*/
|
||||
void readGyro(int *xVal, int *yVal, int *zVal);
|
||||
|
||||
/**
|
||||
* Reads the internal temperature
|
||||
*
|
||||
* @return 16-bit integer containing the scaled temperature reading
|
||||
*/
|
||||
int16_t getTemperature();
|
||||
|
||||
/**
|
||||
* Reads the X, Y, and Z axis of both gyroscope and accelerometer
|
||||
*
|
||||
* @param xA Pointer to returned X-axis value of accelerometer
|
||||
* @param yA Pointer to returned Y-axis value of accelerometer
|
||||
* @param zA Pointer to returned Z-axis value of accelerometer
|
||||
* @param xG Pointer to returned X-axis value of Gyroscope
|
||||
* @param yG Pointer to returned Y-axis value of Gyroscope
|
||||
* @param zG Pointer to returned Z-axis value of Gyroscope
|
||||
*/
|
||||
void readMotion(int *xA, int *yA, int *zA, int *xG, int *yG, int *zG);
|
||||
|
||||
/**
|
||||
* Turns shock detection notifications on/off
|
||||
*
|
||||
* @param enable enables/disables notifications
|
||||
*/
|
||||
void enableShockDetection(bool enable);
|
||||
|
||||
/**
|
||||
* Has there been a shock detected?
|
||||
*
|
||||
* @return true if any unprocessed shock notifications are in the queue
|
||||
*/
|
||||
bool isShockDetected();
|
||||
|
||||
/**
|
||||
* Gets shock detect data from queue
|
||||
*
|
||||
* @param axis gets axis data
|
||||
* @param direction gets direction data
|
||||
*/
|
||||
void getShockDetectData(int *axis, int *direction);
|
||||
|
||||
/**
|
||||
* Turns step counter notifications on/off
|
||||
*
|
||||
* @param enable enables/disables notifications
|
||||
*/
|
||||
void enableStepCounter(bool enable);
|
||||
|
||||
/**
|
||||
* Has there been a step detected?
|
||||
*
|
||||
* @return true if any unprocessed step notifications are in the queue
|
||||
*/
|
||||
bool isStepDetected();
|
||||
|
||||
/**
|
||||
* Gets step count data from queue
|
||||
*
|
||||
* @param count the total number of steps taken
|
||||
*/
|
||||
void getStepCount(int *count);
|
||||
|
||||
/**
|
||||
* Turns tap detection notifications on/off
|
||||
*
|
||||
* @param enable enables/disables notifications
|
||||
*/
|
||||
void enableTapDetection(bool enable);
|
||||
|
||||
/**
|
||||
* Has there been a tap detected?
|
||||
*
|
||||
* @return true if any unprocessed tap notifications are in the queue
|
||||
*/
|
||||
bool isTapDetected();
|
||||
|
||||
/**
|
||||
* Gets tap detect data from queue
|
||||
*
|
||||
* @param axis gets axis data
|
||||
* @param direction gets direction data
|
||||
*/
|
||||
void getTapDetectData(int *axis, int *direction);
|
||||
|
||||
/**
|
||||
* Locks responses from Firmata
|
||||
*/
|
||||
void lock();
|
||||
|
||||
/**
|
||||
* Unlocks responses from Firmata
|
||||
*/
|
||||
void unlock();
|
||||
|
||||
/**
|
||||
* Wait for a response from Firmata before proceeding
|
||||
*/
|
||||
void waitForResponse();
|
||||
|
||||
/**
|
||||
* Proceed with original function call now that response
|
||||
* from Firmata has been received
|
||||
*/
|
||||
void proceed();
|
||||
|
||||
/**
|
||||
* Set results being returned from Firmata for processing
|
||||
*
|
||||
* @param buf is the buffer
|
||||
* @param length is the length of results buffer
|
||||
*/
|
||||
void setResults(uint8_t* buf, int length);
|
||||
|
||||
/**
|
||||
* Processes asyncronous responses returned from Firmata
|
||||
*/
|
||||
void processResponse();
|
||||
|
||||
private:
|
||||
mraa_firmata_context m_firmata;
|
||||
pthread_mutex_t m_responseLock;
|
||||
pthread_cond_t m_responseCond;
|
||||
char* m_results;
|
||||
|
||||
std::queue<IMUDataItem*> m_shockData;
|
||||
std::queue<int> m_stepData;
|
||||
std::queue<IMUDataItem*> m_tapData;
|
||||
};
|
||||
|
||||
}
|
19
src/curieimu/javaupm_curieimu.i
Normal file
19
src/curieimu/javaupm_curieimu.i
Normal file
@ -0,0 +1,19 @@
|
||||
%module javaupm_curieimu
|
||||
%include "../upm.i"
|
||||
|
||||
%{
|
||||
#include "curieimu.hpp"
|
||||
%}
|
||||
|
||||
%include "curieimu.hpp"
|
||||
|
||||
%pragma(java) jniclasscode=%{
|
||||
static {
|
||||
try {
|
||||
System.loadLibrary("javaupm_curieimu");
|
||||
} catch (UnsatisfiedLinkError e) {
|
||||
System.err.println("Native code library failed to load. \n" + e);
|
||||
System.exit(1);
|
||||
}
|
||||
}
|
||||
%}
|
8
src/curieimu/jsupm_curieimu.i
Normal file
8
src/curieimu/jsupm_curieimu.i
Normal file
@ -0,0 +1,8 @@
|
||||
%module jsupm_curieimu
|
||||
%include "../upm.i"
|
||||
|
||||
%{
|
||||
#include "curieimu.hpp"
|
||||
%}
|
||||
|
||||
%include "curieimu.hpp"
|
11
src/curieimu/pyupm_curieimu.i
Normal file
11
src/curieimu/pyupm_curieimu.i
Normal file
@ -0,0 +1,11 @@
|
||||
// Include doxygen-generated documentation
|
||||
%include "pyupm_doxy2swig.i"
|
||||
%module pyupm_curieimu
|
||||
%include "../upm.i"
|
||||
|
||||
%include "stdint.i"
|
||||
|
||||
%include "curieimu.hpp"
|
||||
%{
|
||||
#include "curieimu.hpp"
|
||||
%}
|
Loading…
x
Reference in New Issue
Block a user