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()