|
|
大家共享一下，mpu6050顯示在OLED12864上
單片機源程序如下:
- #include "stc15.h"
- #include "intrins.h"
- #include "codetab.h"
- #include "LQ12864.h"
- #include "mpu6050.h"
- #include "uart.h"
- #include "motor.h"
- #include "key.h"
- float P_angle = 2.1;
- //#include "smoothing.h"
- /********************（STC12C5608AD 11MHZ z=1時精確延時1ms）*******************/
- void delayms(unsigned int z)
- {
- unsigned int x,y;
- for(x=z; x>0; x--)
- for(y=1848; y>0; y--);
- }
- float ABS(float x)
- {
- if(x>0)
- return x;
- else if(x<=0)
- return (-1)*x;
- }
- /*********************主函數(shù)************************************/
- void main(void)
- {
- InitMPU6050(); // 初始化MPU6050
- LCD_Init(); // oled 初始化
- PWM_Init();
- while(1)
- {
- z=-20;
- key_scan();
- MPU6050_change();
- display();
- pwm=P_angle*angleZ;
- if(pwm<0)
- {
- pwm=(-1)*pwm;
- if(pwm>=40)
- pwm=40;
- M_B();
- }
- else if(pwm>0)
- {
- if(pwm>=40)
- pwm=40;
- M_G();
- }
- }
- }
- void timer0() interrupt 1 /* T0中斷服務(wù)程序 */
- {
- TH0=(65536-10000)/256;
- TL0=(65536-10000)%256;
- if(t<pwm)
- {
- en1=1;
- en2=1;
- ……………………
- …………限于本文篇幅 余下代碼請從51黑下載附件…………
所有資料51hei提供下載:
平衡車.zip
(87.3 KB, 下載次數(shù): 89)
2017-7-27 14:29 上傳
點擊文件名下載附件
mpu6050在OLED上顯示
|
|
