질문게시판 > atmega128 소스결합 오류

TODAY743 TOTAL640,449
사이트 이용안내
Login▼/회원가입
최신글보기 질문게시판 기술자료 동영상강좌

아두이노 센서 ATMEGA128 PWM LED 초음파 AVR 블루투스 LCD UART 모터 적외선


BASIC4MCU | 질문게시판 | atmega128 소스결합 오류

페이지 정보

작성자 일본인호ㅈ두 작성일2019-08-21 15:29 조회63회 댓글1건

첨부파일

본문

	

atmega128을 사용해서 작품을 만들고있는도중 소스를 따로따로 돌렸을때는 작동이 되었는데 소스들을 조금식 참고해서 결합시키니 센서들과 부품들이 마음데로 작동이 안됩니다 ㅠㅠ  레지스터에서 겹치는게 있는지 봐도 잘 모르겠네요. 그리고 자이로센서 코딩은 받은거라서 뭐를 건드려야할지도 잘모르겠네요ㅜ

사용하는 센서는 자이로센서(MPU-6050) , 블루투스(HC-06)와 서보모터(HS-311),360도 서보모터,dc모터(모터드라이브를 납땜하여 만들어 사용했습니다)

 

자이로센서 PD0,PD1

블루투스 PE0,PE1

dc모터(드라이브) :PB0,BP1,PB2,PB3,PB4(PWM)

서보모터 :PB5,PB6

 

 

#include <avr/io.h>
#include <stdlib.h>
#include <util/delay.h>
#include <math.h>
#include <stdio.h>
#include <string.h>
#include <util/delay.h>
#include <avr/interrupt.h>
#define F_CPU 16000000UL


#include<avr/signal.h>
unsigned  char led;
unsigned  char T = 0;
int a = 0;
int i;
int x=15;
typedef unsigned char byte;

 

//블루투스

volatile unsigned char flag;
ISR(USART0_RX_vect)
{
    flag=UDR0;
}

 

//서보모터
int d; int c;
void RC_Motor1(int angle){ // angle : -90도 ~ +90도
    int i;
    i=(angle)*18+3000;
    OCR1A=i; //PB5
 
}
void RC_Motor(int angle){ // angle : -90도 ~ +90도
    int w;
    w=(angle)*18+3000;
   
 OCR1B=w; //PB6
}

 


byte MPU6050_read(byte addr);
void MPU6050_write(byte addr, char data);
void TX_CHAR(char data);
void TX_STR(char *s);
char str[100];

void getRawData();
void getAcclDegree();
void getGyroDegree();
void compFilter();
void gyro1(byte roll, byte pitch);

volatile double dt = 0.000;
volatile int gx = 0, gy = 0, gz = 0, ax = 0, ay = 0, az = 0;
volatile long x_aTmp1, y_aTmp1, z_aTmp1;
volatile float x_aTmp2, y_aTmp2, z_aTmp2, x_aResult, y_aResult, z_aResult;
volatile float x_gTmp1, y_gTmp1, x_gResult, y_gResult;

float kp = 12.0f, ki = 1.0f;
volatile float xTmp1, yTmp1, xTmp2, yTmp2, xIntTmp1, yIntTmp1;
volatile float xFilterAngle = 0.0f, yFilterAngle = 0.0f;
volatile int pitch = 0, roll = 0;
byte buffer[12];

 

 

//블루투스

void init()
{
    DDRA=0xff;
    UCSR0A=0x00;
      UCSR0B=0x98;
      UCSR0C=0x06;
      UBRR0H=0;
      UBRR0L=103;
    SREG=0x80;


}
//=====================================================================//
int main(void){
   
    DDRB=0xFF;   // PB5,6 out
 TCCR1A=0xAA; TCCR1B=0x1A; OCR1A=3000; OCR1B=3000;  ICR1=47999;

 

//dc모터 (속도제어)
     TIMSK = 0x01;
  TCCR0 = 0x7F;
 OCR0 = 172;

 

 

//자이로 센서
 UBRR0H=0; UBRR0L=103; UCSR0B=0x08;
   DDRA=0xff;
   DDRE  = 0xFF;
   DDRD=0x0f;
    DDRB=0xFF;
    SREG = 0x00;

    TWSR = 0x00;
    TWBR = 0x12;
    SREG = 0x80;

 //printf("\n\r start!! ");
    MPU6050_write(0x6B, 0x00);
    MPU6050_write(0x6C, 0x00);

//_delay_ms(100);
 //printf("\n\rqqqqq");

 init();
    while(1){

 getRawData();
        getAcclDegree();
        getGyroDegree();
        compFilter();

 

// 자이로 센서를 이용한 서보모터 각도제어

RC_Motor(d);
RC_Motor1(c);
  if(roll>5){
 d=d+1;
 if(d>35){
 d=35;
 }
 
   } 


 if(roll<-5){
    d=d-1;
 if(d<-40){
 d=-40;
 }
 //블루투스를 이용한 dc모터 제어
  }

 if(flag=='U')
    {
   
  PORTB=0x05;    
 
  
 }
 if(flag=='D')
    {
  PORTB=0x0A;   
      
 }
 if(flag=='S')
    {
  PORTB=0x00  ;  
  
       
 }
 if(flag=='R')
    {
  PORTB=0x09;      
 }
 if(flag=='L')
    {
  PORTB=0x06;  
 


 //블루투스를 이용한 360도 서보모터 
 }

  if(flag=='r')
        {
            for(c=0; c<31; c++)
            _delay_ms(10);
   
        }
  if(flag=='l')
        {
            for(c=0; c>-31; c--)
            _delay_ms(10);
   
        }
        if(flag=='s')
        {
   c=0;
        }

    }
 }


void TX_CHAR(char data)     //1바이트 송신
{
 while(!(UCSR0A&0x20));
 UDR0=data;
}

void TX_STR(char *s)
{
 while(*s)TX_CHAR(*s++);
 _delay_ms(5);
}

 


 

// 센서값 읽

byte MPU6050_read(byte addr)
{
 byte dat;
 TWCR = 0xA4;
 while(((TWCR & 0x80) == 0x00 || ((TWSR & 0xF8) != 0x08)));
 TWDR = 0xD0;
 TWCR = 0x84;
 while(((TWCR & 0x80) == 0x00 || ((TWSR & 0xF8) != 0x18)));

 TWDR = addr;
 TWCR = 0x84;

 while(((TWCR & 0x80) == 0x00 || ((TWSR & 0xF8) != 0x28)));
 TWCR = 0xA4;

//-------------------------------------------------------------


 while(((TWCR & 0x80) == 0x00 || ((TWSR & 0xF8) != 0x10)));
 TWDR = 0xD1;
 TWCR = 0x84;
 while(((TWCR & 0x80) == 0x00 || ((TWSR & 0xF8) != 0x40)));
 TWCR = 0x84;
 while(((TWCR & 0x80) == 0x00 || ((TWSR & 0xF8) != 0x58)));
 dat = TWDR;
 TWCR = 0x94;
_delay_us(10);
 return dat;
}

 


   //센서값에 며령어 전
void MPU6050_write(byte addr, char data)
{
 _delay_us(50);
printf("\n\r 6050 write in !!");////////////////////
TWCR = 0xA4;
 while(((TWCR & 0x80) == 0x00 || ((TWSR & 0xF8) != 0x08)));
 TWDR = 0xD0;
 TWCR = 0x84;
 while(((TWCR & 0x80) == 0x00 || ((TWSR & 0xF8) != 0x18)));
 TWDR = addr; // addr = 0x43
 TWCR = 0x84;

 while(((TWCR & 0x80) == 0x00 || ((TWSR & 0xF8) != 0x28)));

//-------------------------------------------------------------

 TWDR = data;
 TWCR = 0x84;
 while(((TWCR & 0x80) == 0x00 || ((TWSR & 0xF8) != 0x28)));
 TWCR = 0x94;
 _delay_us(50);
 printf("\n\r 6050 write out !!");///////////////
}

 
// 가속도 각속도 센서값 읽기 
void getRawData()

    buffer[0] = MPU6050_read(0x3B);
    buffer[1] = MPU6050_read(0x3C);
    buffer[2] = MPU6050_read(0x3D);
    buffer[3] = MPU6050_read(0x3E);
    buffer[4] = MPU6050_read(0x3F);
    buffer[5] = MPU6050_read(0x40);
    buffer[6] = MPU6050_read(0x43);
    buffer[7] = MPU6050_read(0x44);
    buffer[8] = MPU6050_read(0x45);
    buffer[9] = MPU6050_read(0x46);
    buffer[10] = MPU6050_read(0x47);
    buffer[11] = MPU6050_read(0x48);

    ax = (int)buffer[0] << 8 | (int)buffer[1];
    ay = (int)buffer[2] << 8 | (int)buffer[3];
    az = (int)buffer[4] << 8 | (int)buffer[5];
    gx = (int)buffer[6] << 8 | (int)buffer[7];
    gy = (int)buffer[8] << 8 | (int)buffer[9];
    gz = (int)buffer[10] << 8 | (int)buffer[11];

}

 


//각속도

void getAcclDegree(void)

{

    x_aTmp1 = ((long)ay * (long)ay) + ((long)az * (long)az);
    y_aTmp1 = ((long)ax * (long)ax) + ((long)az * (long)az);
    z_aTmp1 = ((long)ay * (long)ay) + ((long)az * (long)az);
    x_aTmp2 = sqrt((float)x_aTmp1);
    y_aTmp2 = sqrt((float)y_aTmp1);
    z_aTmp2 = sqrt((float)z_aTmp1);
    x_aResult = atan((float)ax / x_aTmp2);
    y_aResult = atan((float)ay / y_aTmp2);
    z_aResult = atan(z_aTmp2 / (float)az);

}

 


// 가속도 값

void getGyroDegree(void)
{

    x_gTmp1 = (float)gx / 65536;
    y_gTmp1 = (float)gy / 65536;
    x_gTmp1 = x_gTmp1 * 1.8;
    y_gTmp1 = y_gTmp1 * 1.8;
    x_gResult = x_gTmp1;
    y_gResult = y_gTmp1;

}

 


// 센서값 보정 필터

void compFilter(void)
{

    xTmp1 = (-y_aResult) + (float)xFilterAngle;
    xIntTmp1 = (float)xIntTmp1 + (xTmp1 / 100);
    xTmp2 = (-kp * xTmp1) + (-ki * (float)xIntTmp1) + x_gResult;
    xFilterAngle = xFilterAngle + (xTmp2 / 100);
    pitch = (int)(xFilterAngle * 180 / 3.14);

    yTmp1 = (-x_aResult) + (float)yFilterAngle;
    yIntTmp1 = (float)yIntTmp1 + (yTmp1 / 100);
    yTmp2 = (-kp * yTmp1) + (-ki * (float)yIntTmp1) + y_gResult;
    yFilterAngle = yFilterAngle + (yTmp2 / 100);
    roll = (yFilterAngle * 180 / 3.14);
}
 

  • BASIC4MCU 작성글 SNS에 공유하기
  • 페이스북으로 보내기
  • 트위터로 보내기
  • 구글플러스로 보내기

댓글 1

조회수 63

master님의 댓글

master 작성일

가장 어려운 소스를 기준으로
쉬운 것을 하나씩 차례로 붙이면서 동작시키면 이해하기 좋습니다.
완전히 이해하지 못하면 원하는대로 수정하지 못합니다.

질문게시판HOME > 질문게시판 목록

MCU, AVR, 아두이노 등 전자공학에 관련된 질문을 무료회원가입 후 작성해주시면 전문가가 답변해드립니다.
ATMEGA128PWMLED초음파
아두이노AVR블루투스LCD
UART모터적외선ATMEGA
전체 스위치 센서
질문게시판 목록
제목 작성자 작성일 조회
공지 MCU, AVR, 아두이노 등 전자공학에 관련된 질문은 질문게시판에서만 작성 가능합니다. 스태프 19-01-15 677
공지 사이트 이용 안내댓글[9] master 17-10-29 7894
공지 [무료 공개] 소스코드 하이라이트 v2.0 beta [2013.02.07]댓글[1] 이미지첨부파일 master 18-01-23 2961
질문 atmega128a OCRA, B 질문이요 새글 초짜 05:33 6
질문 혹여나 습도값을 슬라이더로 바꿀 수 있을까요? 이미지새글첨부파일 푸링이 19-09-16 4
질문 아두이노 포크레인 중 스텝모터질문 새글 노은우 19-09-16 7
질문 아트메가댓글[2] 새글 전자어렵 19-09-16 14
질문 도와주세요 ㅠㅠ 새글 민서가또 19-09-16 11
질문 아두이노 if문 실행문제 이미지새글첨부파일 sun0100 19-09-16 9
질문 아트메가128댓글[2] 새글 전자어렵 19-09-15 11
답변 답변글 답변 : 아트메가128댓글[4] 새글 master 19-09-15 21
질문 아두이노 IR센서 코딩질문입니다댓글[2] 새글 rkskek 19-09-15 19
질문 아두이노 외부전원 질문드립니다!댓글[2] 새글 빵빵판 19-09-15 11
질문 Timer1_CTC 연습중인데요..댓글[4] 초짜 19-09-13 15
질문 안녕하세요, 인터페이스까지는 완료했습니다 !댓글[12] 이미지첨부파일 푸링이 19-09-12 43
질문 아래 앱인벤터 글에 이어서..댓글[1] 이미지첨부파일 푸링이 19-09-11 18
질문 memcmpf 질문이요댓글[2] 초짜 19-09-10 28
질문 아두이노 네오픽셀 질문드립니다.댓글[1] 호기심왕 19-09-10 28
질문 앱인벤터를 통해 스텝모터를 습도조건에 따라 움직이게 하고싶습니다댓글[5] 푸링이 19-09-10 30
질문 atmega128 의 PWM 모드 질문이요댓글[6] 초짜 19-09-06 85
질문 아두이노 서보모터 제어문제입니다 ㅠ댓글[3] 첨부파일 졸업좀시켜줘요 19-09-05 97
질문 코딩질문이므니다..댓글[1] 첨부파일 베이식 19-09-04 60
질문 아두이노 Oscillator.h 라이브러리 다운 하는법댓글[1] bbhu 19-09-02 47
질문 atmega128a 질문이요댓글[1] 초짜 19-08-30 67
질문 아두이노 이전 고분해능 엔코더 질문에 추가 궁금점이 있습니다!댓글[1] 이미지첨부파일 모터무 19-08-30 33
질문 스크래치X로 아두이노 제어댓글[1] 이미지 승희엄마 19-08-29 54
질문 아두이노 세븐 세그먼트 제어 전전전전 19-08-29 50
답변 답변글 답변 : 아두이노 세븐 세그먼트 제어 master 19-08-29 51
질문 아두이노 모터제어댓글[1] 이미지 오토의반란 19-08-29 77
질문 atmega128을 배우고 싶은 고등학생입니다. 고딩 19-08-28 56
게시물 검색

2019년 1월 2월 3월 4월 5월 6월 7월 8월 9월 10월 11월 12월
2018년 1월 2월 3월 4월 5월 6월 7월 8월 9월 10월 11월 12월
Privacy Policy
MCU BASIC ⓒ 2017
모바일버전으로보기