免费视频淫片aa毛片_日韩高清在线亚洲专区vr_日韩大片免费观看视频播放_亚洲欧美国产精品完整版

#include "Maths.h"

#include "struct_all.h"

/******************************************************************************

函數(shù)原型： void Get_Radian(struct _gyro *Gyro_in,struct _SI_float *Gyro_out)

功    能： 角速度由原始數(shù)據(jù)轉(zhuǎn)為弧度

*******************************************************************************/ 

void Get_Radian(struct _gyro *Gyro_in,struct _SI_float *Gyro_out)

{

Gyro_out->x = (float)(Gyro_in->x * RawData_to_Radian);

Gyro_out->y = (float)(Gyro_in->y * RawData_to_Radian);

Gyro_out->z = (float)(Gyro_in->z * RawData_to_Radian);

}

/******************************************************************************

函數(shù)原型： uint8_t Get_Checksum(uint8_t mydata[])

功    能： MWC上位機(jī)---計(jì)算校驗(yàn)碼

*******************************************************************************/ 

uint8_t Get_Checksum(uint8_t mydata[])

{

uint8_t i;

    uint8_t checksum=0;

uint8_t length = mydata[3];

    for(i=0;i<length+2;i++)

    {

        checksum ^= (mydata[3+i]&0xFF);

    }

    return checksum;

}

// Fast inverse square-root

// See: http://en.wikipedia.org/wiki/Fast_inverse_square_root

// 快速計(jì)算開根號(hào)的倒數(shù)

float invSqrt(float x)

{

  float halfx = 0.5f * x;

  float y = x;

  long i = *(long*)&y;

  i = 0x5f3759df - (i>>1);

  y = *(float*)&i;

  y = y * (1.5f - (halfx * y * y));

  return y;

}

本站僅提供存儲(chǔ)服務(wù)，所有內(nèi)容均由用戶發(fā)布，如發(fā)現(xiàn)有害或侵權(quán)內(nèi)容，請(qǐng)點(diǎn)擊舉報(bào)。