Squashed 'tmk_core/' changes from 7967731..b9e0ea0
b9e0ea0 Merge commit '7fa9d8bdea3773d1195b04d98fcf27cf48ddd81d' as 'tool/mbed/mbed-sdk' 7fa9d8b Squashed 'tool/mbed/mbed-sdk/' content from commit 7c21ce5 git-subtree-dir: tmk_core git-subtree-split: b9e0ea08cb940de20b3610ecdda18e9d8cd7c552
This commit is contained in:
parent
a20ef7052c
commit
1fe4406f37
4198 changed files with 2016457 additions and 0 deletions
|
@ -0,0 +1,193 @@
|
|||
#include "MMA7660.h"
|
||||
|
||||
MMA7660::MMA7660(PinName sda, PinName scl, bool active) : _i2c(sda, scl)
|
||||
{
|
||||
setActive(active);
|
||||
samplerate = 64;
|
||||
|
||||
}
|
||||
|
||||
//Since the MMA lacks a WHO_AM_I register, we can only check if there is a device that answers to the I2C address
|
||||
bool MMA7660::testConnection( void )
|
||||
{
|
||||
if (_i2c.write(MMA7660_ADDRESS, NULL, 0) == 0 )
|
||||
return true;
|
||||
else
|
||||
return false;
|
||||
}
|
||||
|
||||
void MMA7660::setActive(bool state)
|
||||
{
|
||||
char modereg = read(MMA7660_MODE_R);
|
||||
modereg &= ~(1<<0);
|
||||
|
||||
//If it somehow was in testmode, disable that
|
||||
if (modereg && (1<<2)) {
|
||||
modereg &= ~(1<<2);
|
||||
write(MMA7660_MODE_R, modereg);
|
||||
}
|
||||
|
||||
modereg += state;
|
||||
write(MMA7660_MODE_R, modereg);
|
||||
}
|
||||
|
||||
void MMA7660::readData(int *data)
|
||||
{
|
||||
if (!active) {
|
||||
setActive(true);
|
||||
active = true;
|
||||
wait(0.012 + 1/samplerate); //Wait until new sample is ready, my experience is that 1/samplerate isnt needed, but datasheet says so
|
||||
}
|
||||
|
||||
char temp[3];
|
||||
bool alert;
|
||||
|
||||
do {
|
||||
alert = false;
|
||||
read(MMA7660_XOUT_R, temp, 3);
|
||||
for (int i = 0; i<3; i++) {
|
||||
if (temp[i] > 63)
|
||||
alert = true;
|
||||
if (temp[i] > 31)
|
||||
temp[i] += 128+64;
|
||||
data[i] = (signed char)temp[i];
|
||||
}
|
||||
} while (alert);
|
||||
|
||||
if (!active)
|
||||
setActive(false);
|
||||
}
|
||||
|
||||
|
||||
void MMA7660::readData(float *data)
|
||||
{
|
||||
int intdata[3];
|
||||
readData(intdata);
|
||||
for (int i = 0; i<3; i++)
|
||||
data[i] = intdata[i]/MMA7660_SENSITIVITY;
|
||||
}
|
||||
|
||||
float MMA7660::x( void )
|
||||
{
|
||||
return getSingle(0);
|
||||
}
|
||||
|
||||
float MMA7660::y( void )
|
||||
{
|
||||
return getSingle(1);
|
||||
}
|
||||
|
||||
float MMA7660::z( void )
|
||||
{
|
||||
return getSingle(2);
|
||||
}
|
||||
|
||||
|
||||
void MMA7660::setSampleRate(int samplerate)
|
||||
{
|
||||
setActive(false); //Not allowed to be active to change anything
|
||||
int rates[] = {120, 64, 32, 16, 8, 4, 2, 1}; //Alowed samplerates (and their number in array is also number required for MMA)
|
||||
int sampleLoc = 0, sampleError = 10000, temp;
|
||||
for (int i = 0; i<8; i++) {
|
||||
temp = abs( rates[i] - samplerate );
|
||||
if (temp<sampleError) {
|
||||
sampleLoc = i;
|
||||
sampleError=temp;
|
||||
}
|
||||
}
|
||||
|
||||
//Update the samplerate reg
|
||||
temp = read(MMA7660_SR_R);
|
||||
temp &= ~0x07; //Awake sample rate are lowest 3 bit
|
||||
temp |= sampleLoc;
|
||||
write(MMA7660_SR_R, temp);
|
||||
this->samplerate = rates[sampleLoc];
|
||||
setActive(active); //Restore previous active state
|
||||
}
|
||||
|
||||
|
||||
MMA7660::Orientation MMA7660::getSide( void )
|
||||
{
|
||||
char tiltreg = read(MMA7660_TILT_R);
|
||||
|
||||
//We care about 2 LSBs
|
||||
tiltreg &= 0x03;
|
||||
if (tiltreg == 0x01)
|
||||
return MMA7660::Front;
|
||||
if (tiltreg == 0x02)
|
||||
return MMA7660::Back;
|
||||
return MMA7660::Unknown;
|
||||
}
|
||||
|
||||
MMA7660::Orientation MMA7660::getOrientation( void )
|
||||
{
|
||||
char tiltreg = read(MMA7660_TILT_R);
|
||||
|
||||
//We care about bit 2, 3 and 4 (counting from zero)
|
||||
tiltreg &= 0x07<<2;
|
||||
tiltreg >>= 2;
|
||||
if (tiltreg == 0x01)
|
||||
return MMA7660::Left;
|
||||
if (tiltreg == 0x02)
|
||||
return MMA7660::Right;
|
||||
if (tiltreg == 0x05)
|
||||
return MMA7660::Down;
|
||||
if (tiltreg == 0x06)
|
||||
return MMA7660::Up;
|
||||
return MMA7660::Unknown;
|
||||
}
|
||||
|
||||
|
||||
|
||||
//////////////////////////////////////////////
|
||||
///////////////PRIVATE////////////////////////
|
||||
//////////////////////////////////////////////
|
||||
|
||||
|
||||
void MMA7660::write(char address, char data)
|
||||
{
|
||||
char temp[2];
|
||||
temp[0]=address;
|
||||
temp[1]=data;
|
||||
|
||||
_i2c.write(MMA7660_ADDRESS, temp, 2);
|
||||
}
|
||||
|
||||
char MMA7660::read(char address)
|
||||
{
|
||||
char retval;
|
||||
_i2c.write(MMA7660_ADDRESS, &address, 1, true);
|
||||
_i2c.read(MMA7660_ADDRESS, &retval, 1);
|
||||
return retval;
|
||||
}
|
||||
|
||||
void MMA7660::read(char address, char *data, int length)
|
||||
{
|
||||
_i2c.write(MMA7660_ADDRESS, &address, 1, true);
|
||||
_i2c.read(MMA7660_ADDRESS, data, length);
|
||||
}
|
||||
|
||||
float MMA7660::getSingle( int number )
|
||||
{
|
||||
if (!active) {
|
||||
setActive(true);
|
||||
wait(0.012 + 1/samplerate); //Wait until new sample is ready
|
||||
}
|
||||
|
||||
signed char temp;
|
||||
bool alert;
|
||||
|
||||
do {
|
||||
alert = false;
|
||||
temp = read(MMA7660_XOUT_R + number);
|
||||
if (temp > 63)
|
||||
alert = true;
|
||||
if (temp > 31)
|
||||
temp += 128+64;
|
||||
} while (alert);
|
||||
|
||||
if (!active)
|
||||
setActive(false);
|
||||
|
||||
return temp / MMA7660_SENSITIVITY;
|
||||
}
|
207
tool/mbed/mbed-sdk/libraries/tests/peripherals/MMA7660/MMA7660.h
Normal file
207
tool/mbed/mbed-sdk/libraries/tests/peripherals/MMA7660/MMA7660.h
Normal file
|
@ -0,0 +1,207 @@
|
|||
/* Copyright (c) <year> <copyright holders>, MIT License
|
||||
*
|
||||
* 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 "mbed.h"
|
||||
|
||||
|
||||
#ifndef MMA7660_H
|
||||
#define MMA7660_H
|
||||
|
||||
#define MMA7660_ADDRESS 0x98
|
||||
#define MMA7660_SENSITIVITY 21.33
|
||||
|
||||
#define MMA7660_XOUT_R 0x00
|
||||
#define MMA7660_YOUT_R 0x01
|
||||
#define MMA7660_ZOUT_R 0x02
|
||||
#define MMA7660_TILT_R 0x03
|
||||
#define MMA7660_INT_R 0x06
|
||||
#define MMA7660_MODE_R 0x07
|
||||
#define MMA7660_SR_R 0x08
|
||||
|
||||
|
||||
/** An interface for the MMA7660 triple axis accelerometer
|
||||
*
|
||||
* @code
|
||||
* //Uses the measured z-acceleration to drive leds 2 and 3 of the mbed
|
||||
*
|
||||
* #include "mbed.h"
|
||||
* #include "MMA7660.h"
|
||||
*
|
||||
* MMA7660 MMA(p28, p27);
|
||||
*
|
||||
* DigitalOut connectionLed(LED1);
|
||||
* PwmOut Zaxis_p(LED2);
|
||||
* PwmOut Zaxis_n(LED3);
|
||||
*
|
||||
* int main() {
|
||||
* if (MMA.testConnection())
|
||||
* connectionLed = 1;
|
||||
*
|
||||
* while(1) {
|
||||
* Zaxis_p = MMA.z();
|
||||
* Zaxis_n = -MMA.z();
|
||||
* }
|
||||
*
|
||||
* }
|
||||
* @endcode
|
||||
*/
|
||||
class MMA7660
|
||||
{
|
||||
public:
|
||||
/**
|
||||
* The 6 different orientations and unknown
|
||||
*
|
||||
* Up & Down = X-axis
|
||||
* Right & Left = Y-axis
|
||||
* Back & Front = Z-axis
|
||||
*
|
||||
*/
|
||||
enum Orientation {Up, Down,
|
||||
Right, Left,
|
||||
Back, Front,
|
||||
Unknown
|
||||
};
|
||||
|
||||
/**
|
||||
* Creates a new MMA7660 object
|
||||
*
|
||||
* @param sda - I2C data pin
|
||||
* @param scl - I2C clock pin
|
||||
* @param active - true (default) to enable the device, false to keep it standby
|
||||
*/
|
||||
MMA7660(PinName sda, PinName scl, bool active = true);
|
||||
|
||||
/**
|
||||
* Tests if communication is possible with the MMA7660
|
||||
*
|
||||
* Because the MMA7660 lacks a WHO_AM_I register, this function can only check
|
||||
* if there is an I2C device that responds to the MMA7660 address
|
||||
*
|
||||
* @param return - true for successfull connection, false for no connection
|
||||
*/
|
||||
bool testConnection( void );
|
||||
|
||||
/**
|
||||
* Sets the active state of the MMA7660
|
||||
*
|
||||
* Note: This is unrelated to awake/sleep mode
|
||||
*
|
||||
* @param state - true for active, false for standby
|
||||
*/
|
||||
void setActive( bool state);
|
||||
|
||||
/**
|
||||
* Reads acceleration data from the sensor
|
||||
*
|
||||
* When the parameter is a pointer to an integer array it will be the raw data.
|
||||
* When it is a pointer to a float array it will be the acceleration in g's
|
||||
*
|
||||
* @param data - pointer to array with length 3 where the acceleration data will be stored, X-Y-Z
|
||||
*/
|
||||
void readData( int *data);
|
||||
void readData( float *data);
|
||||
|
||||
/**
|
||||
* Get X-data
|
||||
*
|
||||
* @param return - X-acceleration in g's
|
||||
*/
|
||||
float x( void );
|
||||
|
||||
/**
|
||||
* Get Y-data
|
||||
*
|
||||
* @param return - Y-acceleration in g's
|
||||
*/
|
||||
float y( void );
|
||||
|
||||
/**
|
||||
* Get Z-data
|
||||
*
|
||||
* @param return - Z-acceleration in g's
|
||||
*/
|
||||
float z( void );
|
||||
|
||||
/**
|
||||
* Sets the active samplerate
|
||||
*
|
||||
* The entered samplerate will be rounded to nearest supported samplerate.
|
||||
* Supported samplerates are: 120 - 64 - 32 - 16 - 8 - 4 - 2 - 1 samples/second.
|
||||
*
|
||||
* @param samplerate - the samplerate that will be set
|
||||
*/
|
||||
void setSampleRate(int samplerate);
|
||||
|
||||
/**
|
||||
* Returns if it is on its front, back, or unknown side
|
||||
*
|
||||
* This is read from MMA7760s registers, page 12 of datasheet
|
||||
*
|
||||
* @param return - Front, Back or Unknown orientation
|
||||
*/
|
||||
Orientation getSide( void );
|
||||
|
||||
/**
|
||||
* Returns if it is on it left, right, down or up side
|
||||
*
|
||||
* This is read from MMA7760s registers, page 12 of datasheet
|
||||
*
|
||||
* @param return - Left, Right, Down, Up or Unknown orientation
|
||||
*/
|
||||
Orientation getOrientation ( void );
|
||||
|
||||
|
||||
private:
|
||||
|
||||
/**
|
||||
* Writes data to the device
|
||||
*
|
||||
* @param adress - register address to write to
|
||||
* @param data - data to write
|
||||
*/
|
||||
void write( char address, char data);
|
||||
|
||||
/**
|
||||
* Read data from the device
|
||||
*
|
||||
* @param adress - register address to write to
|
||||
* @return - data from the register specified by RA
|
||||
*/
|
||||
char read( char adress);
|
||||
|
||||
/**
|
||||
* Read multiple regigsters from the device, more efficient than using multiple normal reads.
|
||||
*
|
||||
* @param adress - register address to write to
|
||||
* @param length - number of bytes to read
|
||||
* @param data - pointer where the data needs to be written to
|
||||
*/
|
||||
void read( char adress, char *data, int length);
|
||||
|
||||
/**
|
||||
* Reads single axis
|
||||
*/
|
||||
float getSingle(int number);
|
||||
|
||||
I2C _i2c;
|
||||
bool active;
|
||||
float samplerate;
|
||||
};
|
||||
|
||||
|
||||
#endif
|
Loading…
Add table
Add a link
Reference in a new issue