def readAccelGyro2():
alpha = 0.5
b = degree_gyro2.acc()
fxg = 0
fyg = 0
fzg = 0
global ax,ay,az,gx,gy,gz
ax2,ay2,az2,gx2,gy2,gz2 = b.get_data()
fxg = ax2 * alpha + (fxg * (1.0 - alpha))
fyg = ay2 * alpha + (fyg * (1.0 - alpha))
fzg = az2 * alpha + (fzg * (1.0 - alpha))
pitch = (math.atan2(fxg, math.sqrt(fyg*fyg + fzg*fzg))*180.0)/3.14
print "pitch = " ,pitch
def readAccelGyro(): b = degree_gyro2.acc() global ax,ay,az,gx,gy,gz ax,ay,az,gx,gy,gz = b.get_data()