Advertisement
Guest User

Untitled

a guest
Mar 21st, 2019
44
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
text 1.17 KB | None | 0 0
  1. # Now wake the 6050 up as it starts in sleep mode
  2. bus.write_byte_data(address, power_mgmt_1, 0)
  3.  
  4. print("gyro data")
  5. print("---------")
  6.  
  7. gyro_xout = read_word_2c(0x43)
  8. gyro_yout = read_word_2c(0x45)
  9. gyro_zout = read_word_2c(0x47)
  10.  
  11. print("gyro_xout: ", gyro_xout, " scaled: ", (gyro_xout / 131))
  12. print("gyro_yout: ", gyro_yout, " scaled: ", (gyro_yout / 131))
  13. print("gyro_zout: ", gyro_zout, " scaled: ", (gyro_zout / 131))
  14.  
  15. print("")
  16. print("accelerometer data")
  17. print("------------------")
  18.  
  19. accel_xout = read_word_2c(0x3b)
  20. accel_yout = read_word_2c(0x3d)
  21. accel_zout = read_word_2c(0x3f)
  22.  
  23. accel_xout_scaled = accel_xout / 16384.0
  24. accel_yout_scaled = accel_yout / 16384.0
  25. accel_zout_scaled = accel_zout / 16384.0
  26.  
  27. #print("accel_xout: ", accel_xout, " scaled: ", accel_xout_scaled)
  28. #print("accel_yout: ", accel_yout, " scaled: ", accel_yout_scaled)
  29. #print("accel_zout: ", accel_zout, " scaled: ", accel_zout_scaled)
  30.  
  31. print("x rotation: " , get_x_rotation(accel_xout_scaled, accel_yout_scaled, accel_zout_scaled))
  32. print("y rotation: " , get_y_rotation(accel_xout_scaled, accel_yout_scaled, accel_zout_scaled))
  33. return get_y_rotation(accel_xout_scaled, accel_yout_scaled, accel_zout_scaled)
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement