Revision 0:559a18121e83, committed 2011-02-25

Comitter:

nydus

Date:

Fri Feb 25 17:23:42 2011 +0000

Commit message:

Changed in this revision

diff -r 000000000000 -r 559a18121e83 SRF02.cpp
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/SRF02.cpp	Fri Feb 25 17:23:42 2011 +0000
@@ -0,0 +1,89 @@
+#include "SRF02.h"
+
+
+SRF02::SRF02(PinName sda, PinName scl, int addr) : m_i2c(sda, scl), m_addr(addr) {
+    }
+
+SRF02::~SRF02() {
+
+}
+
+//Get the data in centimeters
+
+int SRF02::readcm() {
+
+    char cmd[2];
+    char eco_high[1],eco_low[1]; //this is because the sensor, sends the data in tow bytes, and  you have tu read from two different registers 0x02 and 0x03;
+
+
+// Get range data from SRF02 in centimeters
+    cmd[0] = 0x00;                      
+    cmd[1] = 0x51;                     
+    m_i2c.write(m_addr, cmd, 2);          
+
+    wait(0.07);                         
+
+
+    cmd[0] = 0x02;                        
+    m_i2c.write(m_addr, cmd, 1, 1);        
+    m_i2c.read(m_addr, eco_high, 1);            
+    
+    cmd[0] = 0x03;
+    m_i2c.write(m_addr,cmd,1,1);
+    m_i2c.read(m_addr,eco_low,1);
+
+    int range = (eco_high[0]<<8)|eco_low[0];
+
+    return range;
+}
+
+//Get the data in inches
+
+int SRF02::readinch() {
+
+    char cmd[2];
+    char eco_high[1],eco_low[1]; //this is because the sensor, sends the data in tow bytes, and  you have tu read from two different registers 0x02 and 0x03;
+
+
+// Get range data from SRF02 in inches
+    cmd[0] = 0x00;                      
+    cmd[1] = 0x50;                     
+    m_i2c.write(m_addr, cmd, 2);          
+
+    wait(0.07);                         
+
+
+    cmd[0] = 0x02;                        
+    m_i2c.write(m_addr, cmd, 1, 1);        
+    m_i2c.read(m_addr, eco_high, 1);            
+    
+    cmd[0] = 0x03;
+    m_i2c.write(m_addr,cmd,1,1);
+    m_i2c.read(m_addr,eco_low,1);
+
+    int range = (eco_high[0]<<8)|eco_low[0];
+
+    return range;
+}
+
+void SRF02::change_addr(char new_addr){
+
+//Change adress of the device. Remember to have only one sensor conected to execute this method.
+
+    char cmd[2];
+    
+    cmd[0]=0x00;
+    cmd[1]=0xA0;
+    m_i2c.write(m_addr,cmd,2);
+    cmd[0]=0x00;
+    cmd[1]=0xAA;
+    m_i2c.write(m_addr,cmd,2);
+    cmd[0]=0x00;
+    cmd[1]=0xA5;
+    m_i2c.write(m_addr,cmd,2);
+    cmd[0]=0x00;
+    cmd[1]=new_addr;
+    m_i2c.write(m_addr,cmd,2);
+    
+    }
+    
\ No newline at end of file

diff -r 000000000000 -r 559a18121e83 SRF02.h
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/SRF02.h	Fri Feb 25 17:23:42 2011 +0000
@@ -0,0 +1,38 @@
+#ifndef SRF02_H
+#define SRF02_H
+
+#include "mbed.h"
+
+
+
+class SRF02
+{
+public:
+  //!Creates an instance of the class.
+  /*!
+  Connect module at I2C address addr using I2C port pins sda and scl.
+  SRF08
+  */
+  SRF02(PinName sda, PinName scl, int addr);
+  
+  /*!
+  Destroys instance.
+  */ 
+  ~SRF02();
+  
+  
+  int readcm();     //Read the range data in centimeters
+ 
+  int readinch();   //Read the range data in inches
+  
+  void change_addr(char new_addr);      //Change the adress of the device. This is very usefull when there are more sensors.
+                                        //This function must be executed with only one sensor conected.
+  
+  
+private:
+  I2C m_i2c;
+  int m_addr;
+
+};
+
+#endif
\ No newline at end of file