b6=b5-4000; x1=b6*b6; x1=x1>>12; x1=x1*VB2; x1=x1>>11; x2=AC2; x2=x2*b6; x2=x2>>11; x3=x2+x1; b3=AC1; b3=b3<<2; b3=b3+x3; b3=b3+2; b3=b3>>2; x1=AC3; x1*=b6; x1=x1>>13; x2=b6*b6; x2=x2>>12; x2=x2*VB1; x2=x2>>16; x3=x1+x2; x3=x3+2; x3=x3>>2; b4=x3; b4=b4+32768; b4=b4*AC4; b4=b4>>15; b7=mpu-b3; b7=b7*50000; if(b7<0x80000000) { p=b7; p=p<<1; p=p/b4; } else { p=b7/b4; p=p<<1; } x1=p; x1=x1>>8; x1=x1*x1; x1=x1*3038; x1=x1>>16; x2=-7357; x2*=p; x2=x2>>16; x1+=x2; x1=x1+3791; x1=x1>>4; p+=x1; Presion=p; |