Diff: FXLS8471.cpp

Revision:

1:ac1a9afd8401

Parent:

0:6642dad09196

Child:

2:0eacd0e5db3b

diff -r 6642dad09196 -r ac1a9afd8401 FXLS8471.cpp
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/FXLS8471.cpp	Wed Mar 23 05:34:00 2016 +0000
@@ -0,0 +1,72 @@
+ /* Copyright (c) 2015 NXP Semiconductors. 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 "FXLS8471.h"
+ #include "mbed.h"
+
+FXLS8471::FXLS8471(PinName MOSI, PinName MISO, PinName CLK, PinName CS) : FXLS8471_spi(MOSI,MISO,CLK), FXLS8471_cs(CS)
+ {
+      FXLS8471_cs=1;
+ }
+    
+ void FXLS8471::FXLS8471_config(void)
+ {
+   char d[2]; 
+   d[0] = FXLS8471_CTRL_REG1;                     //Puts device in Standby mode
+   FXLS8471_cs=0;
+   FXLS8471_spi.write(d[0]+128); 
+   FXLS8471_spi.write(0x00);  
+   FXLS8471_spi.write(0x00);  
+   FXLS8471_cs=1;
+          
+   
+   d[0] = FXLS8471_CTRL_REG1;                     //Puts device in Active mode
+   FXLS8471_cs=0;
+   FXLS8471_spi.write(d[0]+128); 
+   FXLS8471_spi.write(0x01);  
+   FXLS8471_spi.write(0x01);  
+   FXLS8471_cs=1;  
+      
+ }
+ 
+  
+ 
+ void FXLS8471::acquire_FXLS8471_data_g(float * a_data)
+ {
+  
+   char data_bytes[7];
+   char d[1];
+   int count=1;
+   d[0]=0x01;
+   
+   FXLS8471_cs=0;
+   FXLS8471_spi.write(d[0]); 
+   FXLS8471_spi.write(0x00);  
+   while(count<7)
+   {  data_bytes[count]= FXLS8471_spi.write(0xff);  count=count+1;
+   }
+   FXLS8471_cs=1;
+   
+   // a_data[0]= ((float)((int16_t)data_bytes[1]));
+   a_data[0] =  ((float)((int16_t)(((data_bytes[1]*256) + (data_bytes[2])))>> 4) * 0.0009765);
+   a_data[1] =  ((float)((int16_t)(((data_bytes[3]*256) + (data_bytes[4])))>> 4) * 0.0009765);
+   a_data[2] =  ((float)((int16_t)(((data_bytes[5]*256) + (data_bytes[6])))>> 4) * 0.0009765);
+   
+ }
+
+     
\ No newline at end of file