Fixed bug with incremental reading. Added CTRL_REG4 initialization.
Read data from the MEMS every .25 sec and send it to UART