Guest User

Untitled

a guest
Apr 20th, 2018
96
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
text 0.95 KB | None | 0 0
  1. `
  2. int MSB = temp[7] << 8;
  3. int LSB = temp[6] & 0x000000FF;
  4. int val = MSB | LSB;
  5. float quatw = val * 0.000061035f;
  6. MSB = temp[9] << 8;
  7. LSB = temp[8] & 0x000000FF;
  8. val = MSB | LSB;
  9. float quatx = val * 0.000061035f;
  10. MSB = temp[11] << 8;
  11. LSB = temp[10] & 0x000000FF;
  12. val = MSB | LSB;
  13. float quaty = val * 0.000061035f;
  14. MSB = temp[13] << 8;
  15. LSB = temp[12] & 0x000000FF;
  16. val = MSB | LSB;
  17. float quatz = val * 0.000061035f;*/
  18.  
  19. /*float sqw = quatw*quatw;
  20. float sqw = quatw*quatw;
  21. float sqx = quatx*quatx;
  22. float sqy = quaty*quaty;
  23. float sqz = quatz*quatz;
  24.  
  25. float gyroX = (float) gyroYY;
  26. float gyroY = (float) gyroZZ;
  27. float gyroZ = (float) gyroXX;*/
  28. float gyroZ = (float) gyroXX;`
Add Comment
Please, Sign In to add comment