질문게시판 > 아두이노코드 합치기 문의드립니다!

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

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


BASIC4MCU | 질문게시판 | 아두이노코드 합치기 문의드립니다!

페이지 정보

작성자 Linie 작성일2022-09-13 20:56 조회92회 댓글0건

첨부파일

본문

	

안녕하세요! 

아두이노 메가보드를 이용해서 코드를 짜고있습니다.

칼만필터를 이용해서 자이로가속도센서(mpu 6050)를 제어하고 gps센서(neo_6M)를 함께 이용하고 있습니다.

가속도 자이로 값이 급격하게 변화할때 gps센서의 값을 이후 블루투스를 이용해서 어플로 전송하고자 합니다.

깃허브와 구글링을 통해서 각각의 코드를 찾아해맨끝에 각각 보드에 구동은 하는데 하나로 합치는데에 어려움을 겪고 있습니다.

이에 도움을 청하고자 문의를 드려봅니다ㅠ

 

첫번째 코드 (GPS)

#include <TinyGPS.h>

 

uint8_t _hour, _minute, _second, _year, _month, _day; // GPS로부터 시간값 읽기

 

#define GPSBAUD 9600

 

TinyGPS gps;

 

float latitude, longitude;

 

void setup() {

  // put your setup code here, to run once:

  Serial.begin(9600);

 

  Serial.println("START...");

  

  Serial1.begin(GPSBAUD);

  Serial1.setTimeout(10);

 

  gps = TinyGPS();

}

 

void loop() {

 

 

    {

     

      

      String temp = "";

      

      while(Serial1.available())     

      {

        char c = Serial1.read();   

        

          if(gps.encode(c))      

          {

            getgps(gps);         

          }   

        

      } 

 

      if(0 < temp.length())

      {

        

  

      }

      

    }

}

 

void getgps(TinyGPS &gps)

{

 

  gps.f_get_position(&latitude, &longitude);

 

  Serial.print("Lat/Long: "); 

  Serial.print(latitude,5); 

  Serial.print(", "); 

  Serial.println(longitude,5);

  

  

  int year;

  byte month, day, hour, minute, second, hundredths;

  gps.crack_datetime(&year,&month,&day,&hour,&minute,&second,&hundredths);

  // Print data and time

  Serial.print("Date: "); Serial.print(month, DEC); Serial.print("/"); 

  Serial.print(day, DEC); Serial.print("/"); Serial.print(year);

  Serial.print("  Time: "); Serial.print(hour+9, DEC); Serial.print(":"); 

  Serial.print(minute, DEC); Serial.print(":"); Serial.print(second, DEC); 

  Serial.print("."); Serial.println(hundredths, DEC);

  

 

  _year = year-2000;

  _month = month;

  _day = day;

  _hour = hour;

  _minute = minute;

  _second = second;

  

 

 Serial.print("Altitude (meters): "); Serial.println(gps.f_altitude());  

 

  Serial.print("Course (degrees): "); Serial.println(gps.f_course()); 

 

  Serial.print("Speed(kmph): "); Serial.println(gps.f_speed_kmph());

  Serial.println();

  

 

  unsigned long chars;

  unsigned short sentences, failed_checksum;

  gps.stats(&chars, &sentences, &failed_checksum);

  Serial.print("Failed Checksums: ");Serial.print(failed_checksum);

  Serial.println(); Serial.println();

   delay(10000);

}

 

 

 

두번째코드(칼만필터를 이용한 자이로가속도센서)

#include "Wire.h"

#include "I2Cdev.h"

#include "MPU6050.h"

 

MPU6050 accelgyro;

 

unsigned long now, lastTime = 0;

float dt;                          

 

int16_t ax, ay, az, gx, gy, gz;            

float aax=0, aay=0,aaz=0, agx=0, agy=0, agz=0;  

long axo = 0, ayo = 0, azo = 0;           

long gxo = 0, gyo = 0, gzo = 0;           

 

float pi = 3.1415926;

float AcceRatio = 16384.0;                

float GyroRatio = 131.0;                    

 

uint8_t n_sample = 8;                      

float aaxs[8] = {0}, aays[8] = {0}, aazs[8] = {0};

long aax_sum, aay_sum,aaz_sum;                     

 

float a_x[10]={0}, a_y[10]={0},a_z[10]={0} ,g_x[10]={0} ,g_y[10]={0},g_z[10]={0};

float Px=1, Rx, Kx, Sx, Vx, Qx;             

float Py=1, Ry, Ky, Sy, Vy, Qy;             

float Pz=1, Rz, Kz, Sz, Vz, Qz;             

 

void setup()

{

    Wire.begin();

    Serial.begin(115200);

 

    accelgyro.initialize();                 

 

    unsigned short times = 200;             

    for(int i=0;i<times;i++)

    {

        accelgyro.getMotion6(&ax, &ay, &az, &gx, &gy, &gz);

        axo += ax; ayo += ay; azo += az;      

        gxo += gx; gyo += gy; gzo += gz;

    

    }

    

    axo /= times; ayo /= times; azo /= times;

    gxo /= times; gyo /= times; gzo /= times; 

}

 

void loop()

{

    unsigned long now = millis();           

    dt = (now - lastTime) / 1000.0;          

    lastTime = now;                         

    accelgyro.getMotion6(&ax, &ay, &az, &gx, &gy, &gz); 

 

    float accx = ax / AcceRatio;             

    float accy = ay / AcceRatio;              

    float accz = az / AcceRatio;            

 

    aax = atan(accy / accz) * (-180) / pi;   

    aay = atan(accx / accz) * 180 / pi;       

    aaz = atan(accz / accy) * 180 / pi;      

 

    aax_sum = 0;                            

    aay_sum = 0;

    aaz_sum = 0;

  

    for(int i=1;i<n_sample;i++)

    {

        aaxs[i-1] = aaxs[i];

        aax_sum += aaxs[i] * i;

        aays[i-1] = aays[i];

        aay_sum += aays[i] * i;

        aazs[i-1] = aazs[i];

        aaz_sum += aazs[i] * i;

    

    }

    

    aaxs[n_sample-1] = aax;

    aax_sum += aax * n_sample;

    aax = (aax_sum / (11*n_sample/2.0)) * 9 / 7.0;

    aays[n_sample-1] = aay;              

    aay_sum += aay * n_sample;               

    aay = (aay_sum / (11*n_sample/2.0)) * 9 / 7.0;

    aazs[n_sample-1] = aaz; 

    aaz_sum += aaz * n_sample;

    aaz = (aaz_sum / (11*n_sample/2.0)) * 9 / 7.0;

 

    float gyrox = - (gx-gxo) / GyroRatio * dt;

    float gyroy = - (gy-gyo) / GyroRatio * dt; 

    float gyroz = - (gz-gzo) / GyroRatio * dt; 

    agx += gyrox;                             

    agy += gyroy;                             

    agz += gyroz;

    

    /* kalman start */

    Sx = 0; Rx = 0;

    Sy = 0; Ry = 0;

    Sz = 0; Rz = 0;

    

    for(int i=1;i<10;i++)

    {                 

        a_x[i-1] = a_x[i]; 

        Sx += a_x[i];

        a_y[i-1] = a_y[i];

        Sy += a_y[i];

        a_z[i-1] = a_z[i];

        Sz += a_z[i];

    

    }

    

    a_x[9] = aax;

    Sx += aax;

    Sx /= 10;

    a_y[9] = aay;

    Sy += aay;

    Sy /= 10;                          

    a_z[9] = aaz;

    Sz += aaz;

    Sz /= 10;

 

    for(int i=0;i<10;i++)

    {

        Rx += sq(a_x[i] - Sx);

        Ry += sq(a_y[i] - Sy);

        Rz += sq(a_z[i] - Sz);

    

    }

    

    Rx = Rx / 9;           

    Ry = Ry / 9;                        

    Rz = Rz / 9;

  

    Px = Px + 0.0025;               

    Kx = Px / (Px + Rx);                 

    agx = agx + Kx * (aax - agx);         

    Px = (1 - Kx) * Px;                 

 

    Py = Py + 0.0025;

    Ky = Py / (Py + Ry);

    agy = agy + Ky * (aay - agy); 

    Py = (1 - Ky) * Py;

  

    Pz = Pz + 0.0025;

    Kz = Pz / (Pz + Rz);

    agz = agz + Kz * (aaz - agz); 

    Pz = (1 - Kz) * Pz;

 

    /* kalman end */

 

    Serial.print("\t FilteredX:");

    Serial.print(agx);

    Serial.print("\t FilteredY:");

    Serial.print(agy);

    Serial.print("\t FilteredZ:");

    Serial.print(agz);Serial.println();

    Serial.print("\n");

    Serial.print("\n");

    

}

 

 바쁘실텐데 긴 글 읽어주셔서 감사합니다 .

  도움을 주신다면 정말 큰 도움이 될 것 같습니다.

  다시 한번 감사합니다.

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

댓글 0

조회수 92

등록된 댓글이 없습니다.

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

MCU, AVR, 아두이노 등 전자공학에 관련된 질문을 무료회원가입 후 작성해주시면 전문가가 답변해드립니다.
ATMEGA128PWMLED초음파
아두이노AVR블루투스LCD
UART모터적외선ATMEGA
전체 스위치 센서
질문게시판 목록
제목 작성자 작성일 조회
공지 MCU, AVR, 아두이노 등 전자공학에 관련된 질문은 질문게시판에서만 작성 가능합니다. 스태프 19-01-15 13348
공지 사이트 이용 안내댓글[26] master 17-10-29 31750
질문 피에조 부저 일시정지 질문입니다. 새글 Tell 22-10-01 6
질문 아두이노 DC, 서보, 스텝모터 동시 제어가 가능할까요?댓글[1] 새글 jundorio8 22-10-01 18
질문 아두이노 신호등led 스위치 버튼 누를때마다 빨강-노랑-초록 변환댓글[1] 새글 고고라네 22-09-30 19
질문 이산화탄소 감지 및 창문 자동 개방 아두이노 코드 질문 새글 남폴스전 22-09-30 18
답변 답변글 답변 : 이산화탄소 감지 및 창문 자동 개방 아두이노 코드 질문 새글 master 22-09-30 9
질문 코드비전 atmega128 led 점등 질문입니다. 새글 후뉴 22-09-30 19
질문 아두이노 수위센서의 입력신호에 따른 서보모터 제어 소스 shon 22-09-29 13
답변 답변글 답변 : 아두이노 수위센서의 입력신호에 따른 서보모터 제어 소스 새글 master 22-09-30 14
질문 아두이노 스위치 하나로 led 변화댓글[1] 제비 22-09-29 24
질문 led하나 스위치 하나로 스위치가 눌릴때마다 변화댓글[1] 돌쇠 22-09-29 36
질문 atmega128 스위치로 7세그먼트 LED 동시조작 시속90 22-09-28 50
답변 답변글 답변 : atmega128 스위치로 7세그먼트 LED 동시조작 master 22-09-29 36
질문 아두이노 led시간 늘리기 면지지 22-09-28 32
답변 답변글 답변 : 아두이노 led시간 늘리기 master 22-09-29 40
질문 액추에이터 아두이노 정,역제어 문제댓글[1] hohoje 22-09-28 41
질문 아두이노 우노와 MDP070N LCD 문의댓글[2] 이미지첨부파일 공공공도도리 22-09-28 46
질문 아두이노로 영상출력이 가능할까요??댓글[1] 김보 22-09-27 64
질문 아두이노 LCD 판넬 연결댓글[1] 이미지첨부파일 나코딩못해잘 22-09-26 80
질문 모터 선정에 관련하여 질문이 있습니다댓글[1] 이미지첨부파일 mint 22-09-24 62
질문 오류에 대한 질문입니다.댓글[1] 첨부파일 Tell 22-09-24 66
질문 스위치를 이용한 led2개의 밝기 순차적으로 조절입니다.댓글[2] Tell 22-09-24 118
질문 atmega128에서 소리감지 센서 질문드립니다.댓글[6] K유 22-09-23 202
질문 avr로 매트랩 이용하고 싶은데 도와주세요 ㅠㅠ댓글[1] 지수진 22-09-22 91
질문 matlab 과 atmega128을 연동하고 싶습니다.댓글[4] dlcldl 22-09-22 129
질문 아두이노 리미트 스위치를 이용한 모터 제어댓글[4] 오모리 22-09-22 115
질문 atmega128코드로 변환 부탁드립니다 K유 22-09-21 74
답변 답변글 답변 : atmega128코드로 변환 부탁드립니다댓글[1] master 22-09-22 80
질문 아두이노 갑자기 기능구현 안됨댓글[1] 면지지 22-09-21 57
게시물 검색

2022년 1월 2월 3월 4월 5월 6월 7월 8월 9월 10월 11월 12월
2021년 1월 2월 3월 4월 5월 6월 7월 8월 9월 10월 11월 12월
2020년 1월 2월 3월 4월 5월 6월 7월 8월 9월 10월 11월 12월
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 ⓒ 2020
모바일버전으로보기