找回密码
 立即注册

QQ登录

只需一步,快速开始

搜索
查看: 3551|回复: 0
打印 上一主题 下一主题
收起左侧

ADXL345_Arduino测角仪制作源码

[复制链接]
跳转到指定楼层
楼主
使用ADXL345测量角度


单片机源程序如下:
  1. #include <Wire.h>  //调用arduino自带的I2C库
  2. #include <LiquidCrystal.h>   //调用arduino自带的LiquidCrystal库

  3. #define Register_ID 0
  4. #define Register_2D 0x2D
  5. #define Register_X0 0x32
  6. #define Register_X1 0x33
  7. #define Register_Y0 0x34
  8. #define Register_Y1 0x35
  9. #define Register_Z0 0x36
  10. #define Register_Z1 0x37
  11. #define pai 3.1415926
  12. unsigned char wave_x,wave_y,wave_z;


  13. LiquidCrystal lcd(12, 11, 5, 4, 3, 2);//设置接口

  14. int ADXAddress = 0xA7>>1;  //转换为7位地址
  15. int reading = 0;
  16. int val = 0;
  17. int X0,X1,X_out;
  18. int Y0,Y1,Y_out;
  19. int Z1,Z0,Z_out;
  20. int Xg,Yg,Zg;

  21. void setup()
  22. {
  23.   lcd.begin(16, 2);  //初始化LCD
  24.   delay(100);
  25.   Wire.begin();  //初始化I2C
  26.   delay(100);
  27.   Wire.beginTransmission(ADXAddress);
  28.   Wire.write(Register_2D);
  29.   Wire.write(8);
  30.   Wire.endTransmission();
  31. }

  32. void loop()
  33. {
  34.   Wire.beginTransmission(ADXAddress);
  35.   Wire.write(Register_X0);
  36.   Wire.write(Register_X1);
  37.   Wire.endTransmission();
  38.   Wire.requestFrom(ADXAddress,2);
  39.   if(Wire.available()<=2);
  40.   {
  41.     X0 = Wire.read();
  42.     X1 = Wire.read();
  43.     X1 = X1<<8;
  44.     X_out = X0+X1;
  45.   }
  46.   
  47.   Wire.beginTransmission(ADXAddress);
  48.   Wire.write(Register_Y0);
  49.   Wire.write(Register_Y1);
  50.   Wire.endTransmission();
  51.   Wire.requestFrom(ADXAddress,2);
  52.   if(Wire.available()<=2);
  53.   {
  54.     Y0 = Wire.read();
  55.     Y1 = Wire.read();
  56.     Y1 = Y1<<8;
  57.     Y_out = Y0+Y1;
  58.   }
  59.   
  60.   Wire.beginTransmission(ADXAddress);
  61.   Wire.write(Register_Z0);
  62.   Wire.write(Register_Z1);
  63.   Wire.endTransmission();
  64.   Wire.requestFrom(ADXAddress,2);
  65.   if(Wire.available()<=2);
  66.   {
  67.     Z0 = Wire.read();
  68.     Z1 = Wire.read();
  69.     Z1 = Z1<<8;
  70.     Z_out = Z0+Z1;
  71.   }
  72.   
  73.   Xg = X_out;
  74.   Yg = Y_out;
  75.   Zg = Z_out;
  76.   Xg=Xg*3.9+3;
  77. Yg*=3.9;
  78. Zg=Zg*3.9-6;
  79. if(Xg<0){Xg=-Xg;wave_x=1;}
  80. else wave_x=0;
  81. if(Yg<0){Yg=-Yg;wave_y=1;}
  82. else wave_y=0;
  83. if(Zg<0){Zg=-Zg;wave_z=1;}
  84. else wave_z=0;
  85. Xg=(int)((atan((double)(Xg/sqrt(pow((double)Yg,2)+pow((double)Zg,2))))*180/pai*10));
  86. Yg=(int)((atan((double)(Yg/sqrt(pow((double)Xg,2)+pow((double)Zg,2))))*180/pai*10));
  87. Zg=(int)((atan((double)(Zg/sqrt(pow((double)Xg,2)+pow((double)Yg,2))))*180/pai*10));
  88. if(wave_z&!wave_x)Xg=1800-Xg;
  89. else if(wave_z&wave_x)Xg=1800+Xg;
  90. else if(!wave_z&wave_x)Xg=3600-Xg;
  91.   lcd.clear(); //清屏
  92.   lcd.print("X = "); //使屏幕显示文字X=
  93.   lcd.print(Xg/10.0);
  94.   lcd.setCursor(0, 1);
  95.   lcd.print("Y = ");
  96.   lcd.print(Yg/10.0);

  97.   delay(300);  //延时0.3秒,刷新频率这里进行调整
  98.   
  99. }
复制代码

所有资料51hei提供下载:
ADXLMOTO.zip (1.04 KB, 下载次数: 21)


评分

参与人数 1黑币 +50 收起 理由
admin + 50 共享资料的黑币奖励!

查看全部评分

分享到:  QQ好友和群QQ好友和群 QQ空间QQ空间 腾讯微博腾讯微博 腾讯朋友腾讯朋友
收藏收藏 分享淘帖 顶 踩
回复

使用道具 举报

您需要登录后才可以回帖 登录 | 立即注册

本版积分规则

手机版|小黑屋|51黑电子论坛 |51黑电子论坛6群 QQ 管理员QQ:125739409;技术交流QQ群281945664

Powered by 单片机教程网

快速回复 返回顶部 返回列表