/* Hardware setup */ const { PORT_I2C = 0, // The first I2C interface should be used. CHIP_ADDR = LIS2DH_I2C_ADDR0, // I2C Address of the chip // (depends on the logic level at the chip's SDO/SA0 pin) } /* Handles for available sensors */ new hACC[TLIS2DH_Handle]; // Handle to manage the TLIS2DH /* 1 sec. timer is used for the general program sequence */ #callback MainTimer() { new iX, iY, iZ; // g-forces read from the LIS2DH // Reads the g-forces [mg] for all 3 axes from the LIS2DH catch(LIS2DH_ReadMeasurement(hACC, iX, iY, iZ)); // Issues g-forces [mg] for all 3 axes via the watch panel #watch("g-forces=x: %0.3fg, y: %0.3fg, z: %0.3fg", iX/1000.0, iY/1000.0, iZ/1000.0); } /* Called up when the device has been prepared for the start of the application by the "salve" function */ #callback appInit() { // Inits the I2C interface catch(rM2M_I2cInit(PORT_I2C, LIS2DH_I2C_CLOCK, 0)); // Initializes I2C communication with the LIS2DH and prepares the LIS2DH for use catch(LIS2DH_Init(hACC, _ ,PORT_I2C, CHIP_ADDR)); // Activates the LIS2DH using the following configuration: // Set output data rate (ODR) to 5.376 kHz (Power-On default = "Power Down") // Enable Low Power mode (Power-On default = disabled) // Enables X, Y, Z axes (Power-On default) new ctrl1 = LIS2DH_CTRL1_ODR_LP_5376HZ | LIS2DH_CTRL1_LP_EN | LIS2DH_CTRL1_XYZ_EN; // Output registers not updated until MSB and LSB have been read (Power-On default = continuous update) // Setting full-scale to 2g (Power-On default) new ctrl4 = LIS2DH_CTRL4_BDU | LIS2DH_CTRL4_FSCALE_2G; catch(LIS2DH_Enable(hACC, ctrl1, ctrl4)); // Initialisation of a cyclic sec. timer setInterval(MainTimer, 1000); } /* Application entry point */ main() { salve( appInit); // Prepares device for application start (enable extended // debug interface, increase console buffer, say hello) }