本芯片利用7A20的重力加速度传感器特性,以绝对度角计算产品的倾斜角度,达到配戴者驼背达到一定角度即报警的功能。
以上来7A20的角度测量代码(部分省略,欢迎加蔡工VX:884838 或18927487776索取,可提供芯片供应及技术支持):
数组6个字节为7A20三轴原始数据,依次为: x轴低8位,x轴高8位,y轴低8位,y轴高8位,z轴低8位,z轴高8位,
angle_algo中调用 cal_angle(x_val,y_val,z_val) 计算出角度值 (非弧度值)
//------------------------------------------------------------------------
//参数: 归一化的x,y,z加速度值
//返回: 角度值
float cal_angle(float ax, float ay, float az)
{
float temp1,temp2,temp3;
temp1 = ax * ax;
temp2 = ay * ay;
temp3 = temp1 + temp2;
temp3 = sqrt(temp3);
(省略部分内容。。。。欢迎加VX索取)
}
//------------------------------------------------------------------------
//参数: 3轴原始数据(6个字节)
//功能: 打印z轴角度值
void angle_algo(unsigned char * p_ori_dat)
{
unsigned char bak_dat[6];
unsigned char i;
signed int x_tmp,y_tmp,z_tmp;
float x_val,y_val,z_val;
float div_para;
for (i=0;i<6;i++)
{
(省略部分内容。。。。欢迎加VX索取)
//------------------------------------