Integrate CCS811 sensor + update code

README.md

@@ -1,3 +1,24 @@
 # capra_telaire_ros
 
-capra_co2_ros is a node to interact with a Telaire T6713 CO2 sensor using I2C.
+capra_co2_ros is a node to interact with a KS0457 keyestudio CCS811 Carbon Dioxide Air Quality sensor using I2C.
+
+
+## Documentation
+Documentation can be found on the [wiki page](https://wiki.keyestudio.com/KS0457_keyestudio_CCS811_Carbon_Dioxide_Air_Quality_Sensor) of the sensor. The [code of the library](https://www.dropbox.com/sh/or1jzflapzbdepd/AAAGrCZgyjPOtNyLYNcyzL90a/Libraries/CCS811?dl=0&preview=CCS811.cpp) was reproduced for a Jetson as we do not use an Arduino.
+
+
+## Pin connections
+The CCS811 sensor has six pins. According to the wiki page, we only need to connect five pins: the ground (GND), the VCC, the data (SDA), the clock (SCL) and the WAKE pin. The WAKE needs to be connected to ground and the sensor feeds off 5V.
+
+
+## Testing on the Jetson AGX Xavier 
+After pluggin the sensor to the Jetson, connect to the Jetson by ssh:
+```ssh markhor­@IPADDR```
+Replace IPADDR by the IP address of the Jetson. It is connected to the Capra network, so a simple netdiscover of the network should give you the IP address.
+
+Launch the code with ```roslaunch capra_telaire_ros telaire.launch```
+
+Make sure that the permissions of the pin you are connected to are right. You can check the address of the pin by executing the following command:
+```sudo i2cdetect -y -r 8```
+
+Seeing 5A after execution of the command indicates the wiring is ok.

src/telaire_node.cpp

@@ -11,17 +11,57 @@
 #include "ros/ros.h"
 #include "std_msgs/String.h"
 
-#define CO2_ADDR 0x15        // default I2C slave address
-#define CO2_DEV "/dev/i2c-1" // default I2C device file
+#define CO2_ADDR 0x5A        // default I2C slave address of CCS811
+#define CO2_DEV "/dev/i2c-8" // default I2C device file (check Jetson wiring)
 
-int main(int argc, char **argv)
+/*I2C ADDRESS*/
+#define CCS811_I2C_ADDRESS1                      0x5A
+#define CCS811_I2C_ADDRESS2                      0x5B
+
+#define CCS811_REG_STATUS                        0x00
+#define CCS811_REG_MEAS_MODE                     0x01
+#define CCS811_REG_ALG_RESULT_DATA               0x02
+#define CCS811_REG_RAW_DATA                      0x03
+#define CCS811_REG_ENV_DATA                      0x05
+#define CCS811_REG_NTC                           0x06
+#define CCS811_REG_THRESHOLDS                    0x10
+#define CCS811_REG_BASELINE                      0x11
+#define CCS811_REG_HW_ID                         0x20
+#define CCS811_REG_HW_VERSION                    0x21
+#define CCS811_REG_FW_BOOT_VERSION               0x23
+#define CCS811_REG_FW_APP_VERSION                0x24
+#define CCS811_REG_INTERNAL_STATE                0xA0
+#define CCS811_REG_ERROR_ID                      0xE0
+#define CCS811_REG_SW_RESET                      0xFF
+
+#define CCS811_BOOTLOADER_APP_ERASE              0xF1
+#define CCS811_BOOTLOADER_APP_DATA               0xF2
+#define CCS811_BOOTLOADER_APP_VERIFY             0xF3
+#define CCS811_BOOTLOADER_APP_START              0xF4
+
+#define CCS811_HW_ID                             0x81
+
+typedef enum{
+        eMode0, //Idle (Measurements are disabled in this mode)
+        eMode1, //Constant power mode, IAQ measurement every second
+        eMode2, //Pulse heating mode IAQ measurement every 10 seconds
+        eMode3, //Low power pulse heating mode IAQ measurement every 60 seconds
+        eMode4  //Constant power mode, sensor measurement every 250ms 1xx: Reserved modes (For future use)
+    }eDRIVE_MODE_t;
+
+    typedef enum{
+        eClosed,      //Idle (Measurements are disabled in this mode)
+        eCycle_1s,    //Constant power mode, IAQ measurement every second
+        eCycle_10s,   //Pulse heating mode IAQ measurement every 10 seconds
+        eCycle_60s,   //Low power pulse heating mode IAQ measurement every 60 seconds
+        eCycle_250ms  //Constant power mode, sensor measurement every 250ms 1xx: Reserved modes (For future use)
+    }eCycle_t;
+
+int main(void)
 {
-    ros::init(argc, argv, "telaire");
-    ros::NodeHandle n;
-    ros::Publisher ppm_publisher = n.advertise<std_msgs::String>("ppm", 1);
 
     int file;
-    std::string filename = "/dev/i2c-1";
+    std::string filename = CO2_DEV;
     int ppmReading;
 
     if ((file = open(filename.c_str(), O_RDWR)) < 0)
@@ -34,35 +74,88 @@ int main(int argc, char **argv)
     if (ioctl(file, I2C_SLAVE, CO2_ADDR) < 0)
     {
         ROS_INFO("Failed to acquire bus access and/or talk to slave.\n");
-        /* ERROR HANDLING; you can check errno to see what went wrong */
         exit(1);
     }
 
-    unsigned char buffer_write[5] = {0x04, 0x13, 0x8b, 0x00, 0x01};
-    unsigned char buffer_read[4];
+    // STARTING SETUP
+    ROS_INFO("Starting setup\n");
+    // Soft reset
+    uint8_t buffer_soft_reset[5] = {CCS811_REG_SW_RESET, 0x11, 0xE5, 0x72, 0x8A};
+    if( write(file, buffer_soft_reset, 5) != 5)
+    {
+        ROS_INFO("Failed to write SOFT RESET to I2C bus \n");
+    }
+    else
+    {
+        ROS_INFO("Sent soft reset\n");
+        usleep(1000);
+        ROS_INFO("Slept 1000us\n");
+    }
+
+    // Bootloader start
+    uint8_t buffer_bootloader[1] = {CCS811_BOOTLOADER_APP_START};
+    if( write(file, buffer_bootloader, 1) != 1)
+    {
+        ROS_INFO("Failed to write BOOTLOADER SETUP to I2C bus \n");
+    }
+    else
+    {
+        ROS_INFO("Sent bootloader setup\n");
+    }
 
-    while (ros::ok())
+    // Set Measurement Mode
+    uint8_t measurement[1] = {0};
+    measurement[0] = (0 << 2) | (0 << 3) | (eMode4 << 4);
+    ROS_INFO("Measurement mode set");
+    uint8_t buffer_measurement_mode[2] = {CCS811_REG_MEAS_MODE, measurement[0]};
+    if( write(file, buffer_measurement_mode, 2) != 2)
     {
-        std_msgs::String msg;
-
-        if( write(file, buffer_write, 5) != 5)
+        ROS_INFO("Failed to write MEASUREMENT MODE to I2C bus \n");
+    }
+    else
+    {
+        ROS_INFO("Sent Measurement mode\n");
+    }
+
+    // Set Temperature and Humidity
+    double buffer_set_temp_hum[5] = {CCS811_REG_ENV_DATA, 50.5, 0, 24.5, 0};
+    if( write(file, buffer_set_temp_hum, 5) != 5)
+    {
+        ROS_INFO("Failed to write TEMP AND HUM to I2C bus \n");
+    }
+    else
+    {
+        ROS_INFO("Set Temp and Hum\n");
+    }
+
+    // FIN SETUP
+    ROS_INFO("End steup\n");
+    uint8_t buffer_fetch_value[2] = {CCS811_REG_ALG_RESULT_DATA, 1};
+    char buffer_read[8];
+    ROS_INFO("Sending request for results\n");
+
+
+    while (true)
+    {
+        if( write(file, buffer_fetch_value, 2) != 2)
         {
-            ROS_INFO("Failed to write to I2C bus \n");
+            ROS_INFO("Failed to write REQUEST FOR DATA to I2C bus \n");
         }
         else
         {
-            usleep(50000);
-            read(file, buffer_read, 4);
+            usleep(100000);
+            read(file, buffer_read, 8);
+
+            // ROS_INFO("buffer_read value: %d, %d, %d, %d, %d, %d, %d, %d \n", buffer_read[0], buffer_read[1], buffer_read[2], buffer_read[3], buffer_read[4], buffer_read[5], buffer_read[6], buffer_read[7]);
 
-            // printf("buffer_read value: %d, %d, %d, %d \n", buffer_read[0], buffer_read[1], buffer_read[2], buffer_read[3]);
+            ppmReading = (((uint16_t)buffer_read[0] << 8) | (uint16_t)buffer_read[1]);
 
-            ppmReading = buffer_read[2] << 8 | buffer_read[3];
-            msg.data = std::to_string(ppmReading);
-            ppm_publisher.publish(msg);
-            // printf("C02 ppm: %d \n", ppmReading);
+            ROS_INFO("C02 ppm: %d \n", ppmReading);
         }
+
         usleep(500000);
+        ROS_INFO("*****\n");
     }
 
     return EXIT_SUCCESS;
-}
+}