void PLEN2::AccelerationGyroSensor::dump()
{
#if _DEBUG
system.outputSerial().println(F("=== running in function : AccelerationGyroSensor::dump()"));
#endif
sampling();
system.outputSerial().println(F("{"));
system.outputSerial().print(F("\t\"Acc X\": "));
system.outputSerial().print(getAccX());
system.outputSerial().println(F(","));
system.outputSerial().print(F("\t\"Acc Y\": "));
system.outputSerial().print(getAccY());
system.outputSerial().println(F(","));
system.outputSerial().print(F("\t\"Acc Z\": "));
system.outputSerial().print(getAccZ());
system.outputSerial().println(F(","));
system.outputSerial().print(F("\t\"Gyro Roll\": "));
system.outputSerial().print(getGyroRoll());
system.outputSerial().println(F(","));
system.outputSerial().print(F("\t\"Gyro Pitch\": "));
system.outputSerial().print(getGyroPitch());
system.outputSerial().println(F(","));
system.outputSerial().print(F("\t\"Gyro Yaw\": "));
system.outputSerial().println(getGyroYaw());
system.outputSerial().println(F("}"));
}
int8_t readSensorData(int16_t* rawData){
getAccX(&(rawData[0]));
getAccY(&(rawData[1]));
getAccZ(&(rawData[2]));
int16_t temp; //drop it
getGyroAll(&temp, &(rawData[3]), &(rawData[4]), &(rawData[5]));
Compass_getRawValues(&(rawData[6]), &(rawData[7]), &(rawData[8]));
return NO_ERR;
}
