Advertisement
Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- # Now wake the 6050 up as it starts in sleep mode
- bus.write_byte_data(address, power_mgmt_1, 0)
- print("gyro data")
- print("---------")
- gyro_xout = read_word_2c(0x43)
- gyro_yout = read_word_2c(0x45)
- gyro_zout = read_word_2c(0x47)
- print("gyro_xout: ", gyro_xout, " scaled: ", (gyro_xout / 131))
- print("gyro_yout: ", gyro_yout, " scaled: ", (gyro_yout / 131))
- print("gyro_zout: ", gyro_zout, " scaled: ", (gyro_zout / 131))
- print("")
- print("accelerometer data")
- print("------------------")
- accel_xout = read_word_2c(0x3b)
- accel_yout = read_word_2c(0x3d)
- accel_zout = read_word_2c(0x3f)
- accel_xout_scaled = accel_xout / 16384.0
- accel_yout_scaled = accel_yout / 16384.0
- accel_zout_scaled = accel_zout / 16384.0
- #print("accel_xout: ", accel_xout, " scaled: ", accel_xout_scaled)
- #print("accel_yout: ", accel_yout, " scaled: ", accel_yout_scaled)
- #print("accel_zout: ", accel_zout, " scaled: ", accel_zout_scaled)
- print("x rotation: " , get_x_rotation(accel_xout_scaled, accel_yout_scaled, accel_zout_scaled))
- print("y rotation: " , get_y_rotation(accel_xout_scaled, accel_yout_scaled, accel_zout_scaled))
- return get_y_rotation(accel_xout_scaled, accel_yout_scaled, accel_zout_scaled)
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement