Diff: scp1000.cpp

Revision:

0:dfe5ae6ea375

Child:

1:a45810688644

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/scp1000.cpp	Mon Sep 27 08:29:02 2010 +0000
@@ -0,0 +1,144 @@
+ /**
+* 
+*
+*/
+
+#include "scp1000.h"
+
+SCP1000::SCP1000(PinName mosi, PinName miso, PinName sck, PinName CSB):
+     _spi(mosi, miso, sck),
+    _CSB(CSB)
+    /* _DRDY(NULL),
+     _TRIG(Null),        
+     _PD(NULL)*/{
+    _CSB = 1;
+    wait(0.1);
+    _CSB = 0;
+    //Force reset
+    _spi.write(((0x06<< 2) | 0x02));
+    _spi.write(0x01);
+    _CSB = 1;
+    wait(0.06);
+    _CSB = 0;
+    //Check starup Procedure has finished
+    int status;
+     do{
+        _spi.write(0x07 << 2);
+        status = _spi.write(0x00);
+        //printf("waiting for startup to finish %i\n", status);
+        wait(0.1);
+    }while((status & 0x01));                                  //Wait for LSB to go low
+    
+    _spi.write(0x1F << 2);
+    status = _spi.write(0x00);
+    if(!(status & 0x01)){
+        printf("Error in Intialisation");
+    }
+    
+    
+    //Set mode as 0x00
+    _spi.write((0x03 << 2) | 0x02);
+    _spi.write(0x00);
+    wait(0.05);
+    
+    //Check DRDDY is low, if not read data
+    _spi.write(0x07 << 2);
+    status = _spi.write(0x00);
+    if(status & 0x20){
+        printf("Data to be read");
+    }
+    
+    //Check OPStatus bit
+    _spi.write(0x04 << 2);
+    status = _spi.write(0x0);
+    if(status & 0x01){
+        printf("Not finished");
+    }   
+    
+    //Activate new mode
+    _spi.write((0x03 << 2) | 0x02);
+    _spi.write(0x0A);
+    
+    
+    
+}
+
+
+void SCP1000::SetMode(SCPMode mode){
+    _CSB = 0;
+    
+  
+    
+    _CSB = 1;
+
+}
+    
+float SCP1000::read(){
+    _CSB = 0;
+
+    if(_isReady() == 1){ 
+        _spi.write(0x1F <<2);
+        int PressureHighest = _spi.write(0x00);
+        _spi.write(0x20 <<2);
+        int PressureHigh = _spi.write(0x00);
+        int Pressurelow = _spi.write(0x00);
+        
+        
+        int pressureValue = Pressurelow | PressureHigh << 8 | (PressureHighest & 0x07) << 16;
+        
+        float pressure = ((float)pressureValue) / 4;
+        
+        _CSB = 1;
+    
+    
+        return(pressure);
+    }else{
+        return(0);
+    }
+}
+float SCP1000::readTemperature(){
+    
+    _CSB = 0;
+    
+    if(_isReady() == 1){ 
+        //ready so now read
+         _spi.write(0x21 << 2);
+        int TempHigh = _spi.write(0x00);
+        int TempLow = _spi.write(0x00);
+        
+        signed int temperatureValue = (TempLow | ((TempHigh & 0x1F) << 8));
+        if(TempHigh & 0x20){
+            //negative
+            temperatureValue = -8192 + temperatureValue;
+        }else{
+            //positive
+            
+        }
+        
+        float temperature = ((float)temperatureValue) * 0.05;
+        _CSB = 1;
+        return(temperature);
+    }else{
+        return(0);
+    }
+}
+    
+ int SCP1000::_isReady(){
+    //Depending on mode wait for it to be ready
+    int status;
+    _CSB = 0;
+    do{
+        _spi.write(0x07 << 2);
+        status = _spi.write(0x00);
+        //printf("waiting %i\n", status);
+        wait(0.2);
+        if(status & 0x10){
+            //bit 4 high - real time error, interrupt has not been read in time - read DataRD16
+            int temp;
+            _spi.write(0x20 << 2);
+            temp = _spi.write(0x00);
+            temp = _spi.write(0x00);
+        }
+    }while(!(status & 0x20));
+ return(1);
+ }
\ No newline at end of file