블로그 이미지
래머
오늘도 열심히 개발하는 개발자입니다.

calendar

1 2 3 4
5 6 7 8 9 10 11
12 13 14 15 16 17 18
19 20 21 22 23 24 25
26 27 28 29 30 31

Notice

2015. 4. 27. 14:00 아두이노작품

얼마전에 저가 rc카를 하나 구매를 했는데

같이 딸려온 rc충전팩이 영 시원찮습니다.

오래방치해서 수명이 다됐거나, 아니면 구라 용량인지 몇시간충전해도 단 몇분이면 rc카가 멈추는 희안한 사태가 벌어져서

버릴까 하다가 그냥 남는 부품도 있고 해서 배터리 충방전기를 만들어 보기로 했습니다.

같이 딸려온 충전아답터는 보니까 과충전 방지 기능이나 전류 제어 같은 기능은 전혀 없는듯하고 그냥

계속 일정 전압과 전류만 지속적으로 공급해주는 단순한 타입인듯한데,

요즘들어 배터리를 많이 가지고 놀다보니 배터리에 대해서 여러가지 정보를 많이 접한지라

왠지 무서워서

충전 시간이라도 제어되는 장치를 만들어 보기로 했습니다.


일단 전체 장치 구성입니다. 왠지 허접해 보이지만

아두이노 나노 호환 모듈을 통해서 제어부를 구성했습니다.

2개의 릴레이 모듈을 사용했는데 각기 전류 흐름을 제어하는 스위치입니다.

1개의 릴레이는 방전부로 가는 통로를 제어하고 있고

나머지 한개의 릴레이는 전압측정부로 가는 흐름을 제어합니다.

마지막 릴레이는 충전전류를 제어하는 역할입니다.



오른쪽 기판에는 3개의 시멘트 저항과 2개의 일반 저항 및 스위치 2개가 있습니다.

2개의 시멘트 저항은 직렬구성되어 있고 릴레이 스위치 및 배터리와 연결되어 배터리 방전회로를 구성하고 있습니다.

한개의 시멘트저항과 2개의 일반저항은 전압측정을 위한 회로를 구성합니다.

배터리 전압을 대략 1/2로 분압해서 아두이노의 아날로그 입력을 통해서 전압을 측정합니다. 

배터리 방전시 일정이하로 떨어질경우 방전을 중지하기 위한 구성입니다.

저항의 오차에 의해서 정밀한 전압측정은 되지 않지만 딱히 다른 방법이 없으니 ㅎㅎ

각 스위치는 충전시간을 선택하는 충전모드 선택과 충방전 루틴을 시작/종료 시키는 역할을 합니다.


아래 사진에 보이는 가변저항은 원래 방전회로를 구성하기 위해서 사용했던 것인데, 실사용결과 완충된 배터리 방전시 하얀 연기를 내뿜으며 불이 날뻔해서

오른쪽의 시멘트 저항으로 교체를 했습니다. 대략 210ma로 방전을 하게 되어 있고 배터리 팩의 전압이 5v이하가 되는 시점에 방전을 종료하도록했습니다(배터리 셀당 대략 1v정도). 전압측정부의 시멘트 저항은 일반저항의 전력초과로 타버리는 것을 방지하기 위한 차원으로 직렬연결해뒀습니다.

1/2분압회로에서 안그래도 저항의 오차가 있는데 시멘트저항이 오차를 증가 시키겠지만 일반저항의 저항값이 매우 크므로(10k Ohm) 크게 신경쓰지 않아도 될정도이지 않나 생각됩니다.


현재 충방전기의 상태를 표시하기 위해서 16 * 2 lcd 디스플레이를 사용했습니다. 오른쪽 2채널릴레이는 위에서 설명했지만

전압측정부와 충전아답터로부터 오는 전류를 제어하는 역할입니다.


아래는 실제 작동영상입니다.




충방전기 소스는 다음과 같습니다.


def.h//////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////

#ifndef DEF_H_

#define DEF_H_


#define BATT_PIN A0        //전압측정핀

#define LELAY_PIN 12        //방전릴레이 제어핀

#define LIMIT_VOLTAGE 5.0f    //방전종지전압


#define BATT_CHK_PIN 3    //전압측정릴레이 제어핀

#define CHARGE_CPIN 4    //충전전류제어 릴레이 핀


#define CHARGE_TIME1 (60 * 60 * 3.64f)    //700mAh배터리팩 충전시간

#define CHARGE_TIME2 (60 * 60 * 5.2f)    //1300mAh배터리팩 충전시간


#define MODE_1 0        //700mAh충전모드

#define MODE_2 1        //1300mmAh충전모드


//충반전기 상태정의

#define STATUS_WAIT 0        //아무런 처리를 하고 있지않음

#define STATUS_DIS_CHARGE 1    //방전중

#define STATUS_CHARGE 2        //충전중

#define STATUS_IDLE 3        //충반전완료됨


#define MODE_PIN 6            //충전시간 선택 버튼 핀

#define STARTSTOP_PIN 7        //충방전 시작/종료 버튼 핀


#endif


CMyTime.h//////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////

#ifndef MYTIME_H_

#define MYTIME_H_


//시간측정기

class CMyTime

{

long m_lTime;

public:

CMyTime()

{

m_lTime = millis();

}


//현재 시간을 캡쳐함

void Capture()

{

m_lTime = millis();

}


//이전에 capture함수를 호출한 시점부터 이함수를 호출한시점까지의 경과 시간을 초단위로 구함

float GetPassedTime()

{

long lpassedTime = millis() - m_lTime;


return (float)lpassedTime * (1.0f / 1000.0f);

}

};

#endif

///////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////

#include <Wire.h>

#include <LiquidCrystal_I2C.h>


#include <inttypes.h>

#include <MemoryFree.h>

#include "def.h"

#include "CMyTime.h"


LiquidCrystal_I2C g_LCD(0x27,16,2);


//전압측정

class CVoltMng

{

public:


void Init()

{

pinMode(BATT_CHK_PIN, OUTPUT);

Enable(false);

}


void Enable(bool bEnable)

{

//digitalWrite(BATT_CHK_PIN, bEnable ? HIGH : LOW);

digitalWrite(BATT_CHK_PIN, bEnable ? LOW : HIGH);

}


float GetVoltage()

{

return ((float)analogRead(BATT_PIN) / 1024.0f) * 5.0f * 2.0f;

}

};


CVoltMng g_VoltMng;


//충전 제어

class CCharger

{

bool m_bEnabled;

bool m_bCompleted;

CMyTime m_CheckTime;

CMyTime m_ScrUpdateTime;

int m_iFlag;

int m_iMode;

float m_fChargeTime;

public:

CCharger()

{

m_fChargeTime = CHARGE_TIME1;

m_iMode = MODE_1;

Clear();

}


void Clear()

{

m_bEnabled = false;

m_bCompleted = false;

}


int GetMode() {return m_iMode;}


void SelectMode1()

{

m_iMode = MODE_1;

m_fChargeTime = CHARGE_TIME1;

}


void SelectMode2()

{

m_iMode = MODE_2;

m_fChargeTime = CHARGE_TIME2;

}


void Init()

{

m_bEnabled = false;

m_bCompleted = false;

pinMode(CHARGE_CPIN, OUTPUT);

EnableRelay(false);

}


bool IsCompleted() {return m_bCompleted;}


void Start()

{

EnableRelay(true);

m_CheckTime.Capture();

m_ScrUpdateTime.Capture();

m_bEnabled = true;

m_iFlag = 0;

}


void Update()

{

if (!m_bEnabled)

return;


if (m_bCompleted)

return;


if (m_ScrUpdateTime.GetPassedTime() >= 1.0f)

{

m_ScrUpdateTime.Capture();

g_LCD.clear();

g_LCD.home();


float fPassedTime = m_CheckTime.GetPassedTime();


long min = (long)(fPassedTime / 60.0f);

long sec = (long)(fPassedTime - (min * 60));


switch(m_iFlag)

{

case 0:

g_LCD.print(min);

g_LCD.print("m ");

g_LCD.print(sec);

g_LCD.print("s");

if (m_iMode == MODE_1)

g_LCD.print(" 700mAh");

else

g_LCD.print(" 1300mAh");

g_LCD.setCursor(0, 1);

g_LCD.print("charging.");


++m_iFlag;

break;

case 1:

g_LCD.print(min);

g_LCD.print("m ");

g_LCD.print(sec);

g_LCD.print("s");

if (m_iMode == MODE_1)

g_LCD.print(" 700mAh");

else

g_LCD.print(" 1300mAh");

g_LCD.setCursor(0, 1);

g_LCD.print("charging..");

++m_iFlag;

break;

case 2:

g_LCD.print(min);

g_LCD.print("m ");

g_LCD.print(sec);

g_LCD.print("s");

if (m_iMode == MODE_1)

g_LCD.print(" 700mAh");

else

g_LCD.print(" 1300mAh");

g_LCD.setCursor(0, 1);

g_LCD.print("charging...");

m_iFlag = 0;

break;

}

}


if (m_CheckTime.GetPassedTime() >= m_fChargeTime)

{

m_bCompleted = true;

EnableRelay(false);

g_LCD.clear();

g_LCD.home();

g_LCD.print("charging completed.");

}

}


void EnableRelay(bool bEnable)

{

digitalWrite(CHARGE_CPIN, bEnable ? LOW : HIGH);

}

};


CCharger g_Charger;


//방전제어

class CDisCharger

{

bool m_bEnabled;

CMyTime m_CheckTime;

CMyTime m_TotalTime;

CMyTime m_EndStepTime;


bool m_bDisChargeCompleted;

int m_iEndStep;

float m_fResultTime;

public:

CDisCharger()

{

Clear();

}


void Clear()

{

m_bEnabled = true;

m_bDisChargeCompleted = false;

m_iEndStep = 0;

m_fResultTime = 0.0f;

}


void Init()

{

m_bEnabled = true;

m_bDisChargeCompleted = false;

m_iEndStep = 0;

m_fResultTime = 0.0f;

m_CheckTime.Capture();

m_TotalTime.Capture();

pinMode(LELAY_PIN, OUTPUT);

EnableDischarger(false);

}


/*

배터리가 지속적으로 방전시 방전이 거의 완료되는 시점에 전압이 급격히 떨어지는데

그렇다고 해서 완전히 방전된것이 아니다.

방전을 중지시키고 약간 대기하게 되면 다시 전압과 전류가  올라가는데

그 시점에 대한 처리

5초간 방전, 2초간 휴식을 계속반복하면서 배터리 전압을 측정해서 이때에 전압이 허용범위이하까지 떨어지면

완전방전되었다고 가정함. 

*/

void ProcessEndStep()

{

if (m_iEndStep == 1)

{

if (m_EndStepTime.GetPassedTime() < 5.0f)

return;

}

else

{

if (m_EndStepTime.GetPassedTime() < 2.0f)

return;

}


m_EndStepTime.Capture();


if (m_iEndStep == 1)

{

EnableDischarger(false);

delay(150);

g_VoltMng.Enable(true);

delay(150);


float fCurVolt = g_VoltMng.GetVoltage();

g_VoltMng.Enable(false);

delay(150);

g_LCD.clear();

g_LCD.home();

g_LCD.print(fCurVolt, 3);


if (m_bDisChargeCompleted)

g_LCD.print("V, end");

else

g_LCD.print("V");


g_LCD.setCursor(0, 1);

g_LCD.print("Time = ");


if (!m_bDisChargeCompleted)

g_LCD.print(m_TotalTime.GetPassedTime() / 60.0f, 2);

else

g_LCD.print(m_fResultTime / 60.0f, 2);


g_LCD.print("min");


if (fCurVolt <= LIMIT_VOLTAGE)

{

m_iEndStep = 3;

return;

}


EnableDischarger(true);


m_iEndStep = 2;

}

else if (m_iEndStep == 2)

{

m_iEndStep = 1;

EnableDischarger(false);

}

}


void Update()

{

if (!m_bEnabled)

return;


if (m_CheckTime.GetPassedTime() < 10.0f)

return;


m_CheckTime.Capture();


if (m_iEndStep == 1 || m_iEndStep == 2)

{

ProcessEndStep();

}

else

{

EnableDischarger(false);

delay(150);

g_VoltMng.Enable(true);

delay(150);

float fCurVolt = g_VoltMng.GetVoltage();

g_VoltMng.Enable(false);

delay(150);

EnableDischarger(true);


if (!m_bDisChargeCompleted && fCurVolt <= LIMIT_VOLTAGE)

{

EnableDischarger(false);

if (m_iEndStep == 3)

{

m_bDisChargeCompleted = true;

m_fResultTime = m_TotalTime.GetPassedTime();

}

else

{

m_iEndStep = 1;

m_EndStepTime.Capture();

}

}


g_LCD.clear();

g_LCD.home();

g_LCD.print(fCurVolt, 3);


if (m_bDisChargeCompleted)

g_LCD.print("V, end");

else

g_LCD.print("V");


switch (g_Charger.GetMode())

{

case MODE_1:

g_LCD.print(", 700mAh");

break;

case MODE_2:

g_LCD.print(", 1300mAh");

break;

}

}


g_LCD.setCursor(0, 1);

g_LCD.print("Time = ");


if (!m_bDisChargeCompleted)

g_LCD.print(m_TotalTime.GetPassedTime() / 60.0f, 2);

else

g_LCD.print(m_fResultTime / 60.0f, 2);


g_LCD.print("min");

}


void EnableDischarger(bool bEnable)

{

digitalWrite(LELAY_PIN, bEnable? HIGH : LOW);

}


bool IsCompleted() {return m_bDisChargeCompleted;}

};


CDisCharger g_DisCharger;


//버튼 스위치 입력처리

class CInputMng

{

bool m_bNowDelay;

CMyTime m_Time;

int m_iPin;

public:

CInputMng(int pin)

{

m_bNowDelay = false;

m_iPin = pin;

m_Time.Capture();

}


void Init()

{

pinMode(m_iPin, INPUT_PULLUP);

}


bool Check()

{

if (m_bNowDelay)

{

if (m_Time.GetPassedTime() > 1.0f)

{

m_bNowDelay = false;

}


return false;

}


if (digitalRead(m_iPin) == LOW)

{

m_bNowDelay = true;

m_Time.Capture();


return true;

}


return false;

}

};


CInputMng g_InputMode(MODE_PIN);

CInputMng g_StartStop(STARTSTOP_PIN);


int g_iCurMode = STATUS_WAIT;


//충반전 루틴 정지

void StopProcessing()

{

g_DisCharger.Init();

g_Charger.Init();

g_iCurMode = STATUS_WAIT;


g_LCD.clear();

g_LCD.home();

g_LCD.print("Stop Processing..");

g_LCD.setCursor(0, 1);

if (g_Charger.GetMode() == MODE_1)

g_LCD.print("700mAh..");

else

g_LCD.print("1300mAh..");

}


//충방전 루틴 시작

void StartProcessing()

{

g_DisCharger.Init();

g_Charger.Init();


g_InputMode.Init();

g_StartStop.Init();


g_DisCharger.EnableDischarger(true);


g_LCD.clear();

g_LCD.home();

g_LCD.print("Discharging..");


g_iCurMode = STATUS_DIS_CHARGE;

}


void setup()

{


  /* add setup code here */


g_LCD.init();

g_LCD.backlight();

g_VoltMng.Init();

g_InputMode.Init();

g_StartStop.Init();


StopProcessing();

}


void loop()

{

if (g_StartStop.Check())

{

if (g_iCurMode != STATUS_WAIT)

{

StopProcessing();

return;

}

else

{

StartProcessing();

return;

}

}


if (g_InputMode.Check())

{

switch(g_Charger.GetMode())

{

case MODE_1:

g_Charger.SelectMode2();

break;

case MODE_2:

default:

g_Charger.SelectMode1();

break;

}


StopProcessing();

return;

}


  /* add main program code here */

if (g_iCurMode == STATUS_DIS_CHARGE)

{

g_DisCharger.Update();


if (g_DisCharger.IsCompleted())

{

g_VoltMng.Enable(false);

g_DisCharger.EnableDischarger(false);

delay(1000);

g_iCurMode = STATUS_CHARGE;

g_Charger.Start();

}

}

else if (g_iCurMode == STATUS_CHARGE)

{

g_Charger.Update();

if (g_Charger.IsCompleted())

{

g_iCurMode = STATUS_IDLE;

}

}

else if (g_iCurMode == STATUS_IDLE)

{

delay(1000);

}

}


'아두이노작품' 카테고리의 다른 글

아두이노 4륜구동  (0) 2015.05.23
밸런싱 로봇 만들어 보기  (105) 2015.05.09
라인트레이서 만들어보기  (1) 2015.03.25
아두이노 스파이더 로봇만들어보기  (0) 2015.02.22
아두이노 탱크 만들어보기  (0) 2015.02.22
posted by 래머
2015. 3. 25. 12:45 아두이노작품

굉장히 빠르고 정밀하게 제어되는 라인트레이서를 보고 저도 만들어보고 싶어 시도를 해봤습니다.


2015-05-17일 최종 튜닝했습니다.

라인트래킹제어 알고리즘을 좀 수정했고, 트랙을 좀손봤습니다(검정테이프질). 운행가능한 최대 속도로 운행될수 있게 했습니다.


센서는 newtc의 AM-IRS4D라는 모듈을 이용햇습니다. 4개의 적외선 센서를 장착하고 있습니다.

가변저항으로 감도를 조정할 수 있으며, 0또는 1로 신호를 출력하게 됩니다.



제어는 아두이노 프로미니 호환 모듈과 ET-DCM이라는 모터드라이버를 사용했습니다. 프로그램은 기존 자율주행 자동차등에서 사용했던 프로그램을 조금 수정하고

라인트래킹 제어루틴을 추가했습니다.


차체는 아카데미 과학의 라인X-II라는 것을 사용했습니다. 구입시 같이 딸려오는 기판과 각종 회로부품들은 잘 짱박아 뒀습니다.


아래는 완성 후 주행영상입니다.

원래 계획은 굉장히 빠르고 정밀하게 제어되는 라인트레이서였는데

그것은 저의 허황된 꿈일 뿐이었습니다.

정밀제어를 위해서는 좀더 많은 수의 센서로부터 입력을 받아야할듯하고, 차체도 정밀제어가 가능하지 않으면 안된다는 것을 알았습니다.

아카데미의 차체는 pwm응당특성이 별로 좋지 않습니다.

그냥 한번만들어봤다는것에 만족하기로 했습니다.


allowfullscreen>


값을 튜닝후



//소스-----------------------------------------------------------------------------------

class CMyTime

{

long m_lTime;

public:

CMyTime()

{

m_lTime = millis();

}


//현재 시간캡쳐

void Capture()

{

m_lTime = millis();

}


//이전에 capture한 시점부터 이함수를 호출하는 시점까지의 경과 시간을 초단위로 구함

float GetPassedTime()

{

long lpassedTime = millis() - m_lTime;


return (float)lpassedTime * (1.0f / 1000.0f);

}

};


#define LINE_PIN_1 2

#define LINE_PIN_2 3

#define LINE_PIN_3 4

#define LINE_PIN_4 7


#define LINE_LEFT_OUTER 0x08

#define LINE_LEFT_INNER 0x04

#define LINE_RIGHT_INNER 0x02

#define LINE_RIGHT_OUTER 0x01


#define LINE_STATUS_ALL (LINE_LEFT_OUTER | LINE_LEFT_INNER | LINE_RIGHT_INNER | LINE_RIGHT_OUTER)


class CLineCheker

{

protected:

char m_cPin1;

char m_cPin2;

char m_cPin3;

char m_cPin4;

public:


CLineCheker(char pin1, char pin2, char pin3, char pin4)

{

m_cPin1 = pin1;

m_cPin2 = pin2;

m_cPin3 = pin3;

m_cPin4 = pin4;

}


void Init()

{

pinMode(m_cPin1, INPUT);

pinMode(m_cPin2, INPUT);

pinMode(m_cPin3, INPUT);

pinMode(m_cPin4, INPUT);

}


char Check()

{

char ret = 0;


if (CheckLine1())

ret |=  LINE_LEFT_OUTER;


if (CheckLine2())

ret |=  LINE_LEFT_INNER;


if (CheckLine3())

ret |=  LINE_RIGHT_INNER;


if (CheckLine4())

ret |=  LINE_RIGHT_OUTER;


return ret;

}


bool CheckLine1()

{

return digitalRead(m_cPin1) == LOW;

}


bool CheckLine2()

{

return digitalRead(m_cPin2) == LOW;

}


bool CheckLine3()

{

return digitalRead(m_cPin3) == LOW;

}


bool CheckLine4()

{

return digitalRead(m_cPin4) == LOW;

}

};


#define LT_UPDATE_TIME (1.0f / 30.0f)


#define LT_DIR_CENTER 0

#define LT_DIR_LEFT 1

#define LT_DIR_RIGHT 2


class CLineTracker

{

protected:

bool m_bEnabled;

CLineCheker m_Checker;

unsigned char m_cLastLeftSpeed, m_cLastRightSpeed;

char m_cLtDir;

char m_cLastStatus;

CMyTime m_Time;

bool m_bEndMark;

float m_fSpeedScale;


float m_fTurnSpeedSlow;

float m_fTurnSpeedQuick;


public:

CLineTracker() : m_Checker(LINE_PIN_1, LINE_PIN_2, LINE_PIN_3, LINE_PIN_4)

{

m_fSpeedScale = 1.0f;

Clear();

}


void Clear()

{

m_bEnabled = false;

m_cLtDir = LT_DIR_CENTER;

m_cLastStatus = 0;

m_bEndMark = false;

m_cLastLeftSpeed = (unsigned char)(255 * m_fSpeedScale);

m_cLastRightSpeed = (unsigned char)(255 * m_fSpeedScale);


m_fTurnSpeedSlow = (255.0f * (54.0f/100.0f));

m_fTurnSpeedQuick = (255.0f * (7.0f/100.0f));

}


void Enable(bool bEnable)

{

Stop();

m_bEnabled = bEnable;

}


bool IsEnabled() {return m_bEnabled;}


char GetLastStatus() {return m_cLastStatus;}

float GetSpeedScale() {return m_fSpeedScale;}

void SetSpeedScale(float f) {m_fSpeedScale = f;}


void SetTurnSpeedSlow(float fPer)

{

m_fTurnSpeedSlow = fPer * 0.01f * 255.0f;

}

void SetTurnSpeedQuick(float fPer)

{

m_fTurnSpeedQuick = fPer * 0.01f * 255.0f;

}


void Init()

{

m_Checker.Init();

m_Time.Capture();

}


void Move(int left, int right)

{

if (left > 255)

left = 255;

if (right > 255)

right = 255;


m_cLastLeftSpeed = (unsigned char)left;

m_cLastRightSpeed = (unsigned char)right;


//모터 드라이버 제어

g_Motor.SmoothTurn(left, right, true);

}


void Stop()

{

g_Motor.StopAll();

Clear();

}


void Forward()

{

m_cLtDir = LT_DIR_CENTER;

Move((int)(255 * m_fSpeedScale), (int)(255 * m_fSpeedScale));

}


void TurnLeft(int speed)

{

m_cLtDir = LT_DIR_LEFT;

//Move((int)(speed * m_fSpeedScale), int(255 * m_fSpeedScale));

Move(speed, 255);

}


void TurnRight(int speed)

{

m_cLtDir = LT_DIR_RIGHT;

//Move((int)(255 * m_fSpeedScale), (int)(speed * m_fSpeedScale));

Move(255, speed);

}

void MoveLastStatus()

{

Move(m_cLastLeftSpeed, m_cLastRightSpeed);

}


char Update()

{

if (!m_bEnabled)

return 0;


if (m_Time.GetPassedTime() < LT_UPDATE_TIME)

return m_cLastStatus;


m_Time.Capture();


m_cLastStatus = m_Checker.Check();



if (m_cLastStatus == LINE_LEFT_OUTER)

{//크게 좌회전

m_bEndMark = false;

TurnLeft(m_fTurnSpeedQuick);

}

else if (m_cLastStatus == LINE_LEFT_INNER)

{//좌회전

m_bEndMark = false;

TurnLeft(m_fTurnSpeedSlow);

}

else if (m_cLastStatus == LINE_RIGHT_INNER)

{//우회전

m_bEndMark = false;

TurnRight(m_fTurnSpeedSlow);

}

else if (m_cLastStatus == LINE_RIGHT_OUTER)

{//크게 우회전

m_bEndMark = false;

TurnRight(m_fTurnSpeedQuick);

}

else if (m_cLastStatus == 0) //아무런 라인인식안됨

{

/*if (m_bEndMark)

Stop();

else*/

Forward();

}

else if (m_cLastStatus == (LINE_LEFT_OUTER | LINE_LEFT_INNER | LINE_RIGHT_OUTER | LINE_RIGHT_INNER))

{

m_bEndMark = true;

Forward();

}

else if ((m_cLastStatus & (LINE_LEFT_OUTER | LINE_LEFT_INNER)) == (LINE_LEFT_OUTER | LINE_LEFT_INNER))

{

m_bEndMark = false;

TurnLeft(m_fTurnSpeedQuick);

}

else if ((m_cLastStatus & (LINE_RIGHT_OUTER | LINE_RIGHT_INNER)) == (LINE_RIGHT_OUTER | LINE_RIGHT_INNER))

{

m_bEndMark = false;

TurnRight(m_fTurnSpeedQuick);

}

else

{

m_bEndMark = false;

MoveLastStatus();

}


return m_cLastStatus;

}

};

posted by 래머
2015. 2. 23. 22:20 아두이노

원문출처 : http://arduino.cc/en/Reference/SPI

SPI library

 

 

This library allows you to communicate with SPI devices, with the Arduino as the master device.


이 라이브러리는 아두이노를 마스터로하여, SPI디바이스들과 통신을 가능하게 한다.

 

A Brief Introduction to the Serial Peripheral Interface (SPI)

직렬 주변장치 인터페이스(SPI)에 대한 간략한소개

Serial Peripheral Interface (SPI) is a synchronous serial data protocol used by microcontrollers for communicating with one or more peripheral devices quickly over short distances. It can also be used for communication between two microcontrollers.


SPI는 근거리에서 마이크로컨트롤러가 하나 또는 여러개의 주변 장치들과 빠르게 통신하기위한 동기식 직렬 데이터 통신 프로토콜이다. 이것은 또한 두개의 마이크로컨트롤러 사이의통신에 사용될 수 있다.


With an SPI connection there is always one master device (usually a microcontroller) which controls the peripheral devices. Typically there are three lines common to all the devices:

SPI연결에서는 항상 하나의 마스터장치가(대개는 마이크로컨트롤러) 주변장치들을 제어한다. 일반적으로 모든 디바이스들은 3개의 공통 라인을 가진다.

  • MISO (Master In Slave Out) - The Slave line for sending data to the master,
  • MISO(마스터입력슬레이브출력) - 마스터에 데이터를 전송하기위한 슬레이브라인
  • MOSI (Master Out Slave In) - The Master line for sending data to the peripherals,
  • MOSI(마스터출력슬레이브입력) - 주변장치에 데이터를 보내기위한 마스터라인
  • SCK (Serial Clock) - The clock pulses which synchronize data transmission generated by the master

  • SCK(시리얼클럭) - 데이터 전송을 동기화 시키는 마스터가 생성하는 클럭 펄스

 

and one line specific for every device:

또한 모든 장치들을 위한 하나의 라인이 명시된다 :

  • SS (Slave Select) - the pin on each device that the master can use to enable and disable specific devices.
  • SS (슬레이브 선택) - 마스터가 특정 장치를 활성/비활성 시킬 수 있는 각 디바이스상의 핀

 

When a device's Slave Select pin is low, it communicates with the master. When it's high, it ignores the master. This allows you to have multiple SPI devices sharing the same MISO, MOSI, and CLK lines.


슬레이브의 SS핀이 low상태가될때, 마스터와 통신하며, HIGH일때는 마스터를 무시한다. 이것은 동일한 MISO, MOSI 및 CLK라인을 공유한 상태에서 다중의 SPI디바이스연결을 가능하게한다.


 

To write code for a new SPI device you need to note a few things:

SPI장치를 위한 코드를 작성할때 약간의 주의가 필요하다 :

  • Is data shifted in Most Significant Bit (MSB) or Least Significant Bit (LSB) first? This is controlled by the SPI.setBitOrder() function.

  • 데이터가 MSB 또는 LSB로 쉬프트 되는가? 이것은 SPI.setBitOrder() 함수로 제어된다.

  • Is the data clock idle when high or low? Are samples on the rising or falling edge of clock pulses? These modes are controlled by the SPI.setDataMode() function.

  • 데이터 클럭의 대기상태가 HIGH신호일때인가 LOW신호일때인가? 클럭펄스의 상승시 아니면 하강시 샘플되는가?
  • 이 모드들은 SPI.setDataMode()함수를 통해 제어된다.

  • What speed is the SPI running at? This is controlled by the SPI.setClockDivider() function.

  • 얼마의 속도로 SPI가 움직이는가? 이것은 SPI.setClockDivider()함수로 제어된다.

 

The SPI standard is loose and each device implements it a little differently. This means you have to pay special attention to the device's datasheet when writing your code.

 

Generally speaking, there are four modes of transmission. These modes control whether data is shifted in and out on the rising or falling edge of the data clock signal (called the clock phase), and whether the clock is idle when high or low (called the clock polarity). The four modes combine polarity and phase according to this table:


SPI표준은 느슨하고, 각 장치들의 구현에는 약간씩 차이가 있다. 이것이 의미하는것은 코드 작성시 장치의  데이터시트를 주의해서 참조 할 필요가 있다는 것이다. 일반적으로 말해서, 데이터 전송에는 4개의 모드가 있다.이모드들은 클럭 신호의 상승 또는 하강에지에서 데이터의 입/출력 시프트를 할지(클럭 위상이라 불린다), 클럭의 대기상태가 HIGH신호인지 LOW신호인지(클럭의 극성이라 불린다)이다. 4개의 모드들은 아래테이블에서 보여지는것처럼 극성과 위상의  조합을 통해서 만들어진다.

 

ModeClock Polarity (CPOL)Clock Phase (CPHA)
SPI_MODE000
SPI_MODE101
SPI_MODE210
SPI_MODE311

 

The SPI.setDataMode() function lets you set the mode to control clock polarity and phase.


당신은 SPI.setDataMode()함수 호출로  클럭의 극성과 위상 제어모드를 설정할 수 있다.


 

Every SPI device has a maximum allowed speed for SPI Bus. The SPI.setClockDivider() allows you to change the clock speed to make your device working properly (default is 4MHz).


모든 SPI장치들은 SPI 버스 상에서 사용할 수 있는 제한된 최대 속도를 가진다. SPI.setClockDivider()함스로 당신의 장치가 알맞게 작업할 수 있도록 클럭속도를 변경할 수 있다(기본은 4MHz다).


 

Once you have your SPI parameters set correctly you just need to figure which registers in your device control which functions, and you're good to go. This will be explained in the data sheet for your device.

 

For more on SPI, see Wikipedia's page on SPI.


SPI파라메터들을 올바르게 설정했다면, 남은 것은 단지 디바이스를 제어하기 위한 레지스터와 함수들이 참조하는것이다.

이것은 당신의 디바이스 데이터시트에 설명되어 있을것이다.

SPI에 대한 좀더 자세한 부분은, Wikipedia's SPI부분을 참조하라.

 

Connections(연결)

The following table display on which pins the SPI lines are broken out on the different Arduino boards:


다음의 테이블은 서로다른 아두이노 보드들에서 어떠한 핀들이 SPI라인들인지 나타낸다.

 

Arduino BoardMOSIMISOSCKSS (slave)SS (master)
Uno or Duemilanove11 or ICSP-412 or ICSP-113 or ICSP-310-
Mega1280 or Mega256051 or ICSP-450 or ICSP-152 or ICSP-353-
LeonardoICSP-4ICSP-1ICSP-3--
DueICSP-4ICSP-1ICSP-3-4, 10, 52

 

Note that MISO, MOSI, and SCK are available in a consistent physical location on the ICSP header; this is useful, for example, in designing a shield that works on every board.

주의할점은 MISO, MOSI, SCK핀들은 ICSP헤더의 물리적 위치에서 사용될 수 있다는 것이다; 이것은 유용한데, 예를 들면, 모든 보드들 위에서 움직이는 쉴드의 디자인같은 것이다.


 

 

Note about Slave Select (SS) pin on AVR based boards

AVR기반 보드들에서의 슬레이브 선택(SS)핀에 대한 기록


All AVR based boards have an SS pin that is useful when they act as a slave controlled by an external master. Since this library supports only master mode, this pin should be set always as OUTPUT otherwise the SPI interface could be put automatically into slave mode by hardware, rendering the library inoperative.

 

It is, however, possible to use any pin as the Slave Select (SS) for the devices. For example, the Arduino Ethernet shield uses pin 4 to control the SPI connection to the on-board SD card, and pin 10 to control the connection to the Ethernet controller.

모든 AVR기반 보드들은 외부의 마스터 장치로 부터 슬레이브로 제어될 수 있도록 SS핀을 가지고 있다. 라이브러리는 마스터모드만 지원하므로, 이핀은 항상 출력으로 설정되지만, 다른 경우에 SPI인터페이스는 하드웨어를 자동적으로 슬레이브 모드가 되게 할 수 있으며, 이핀을 무시하게 만들어졌다.

어쨌든, 디바이스의 SS에 어떠한 핀이든 사용될 수 있다. 예를들어, 아두이노 이더넷 쉴드는 4번핀을 온보드 SD카드와 SPI통신하기 위한 제어핀으로 이용하며,  10번은 이더넷 컨트롤러와 연결을 제어한다. 


 

Extended SPI functionality for the Due

두에를 위한 SPI 기능 확장


The Arduino Due's SPI interface works differently than any other Arduino boards. The library can be used on the Due with the same methods available to other Arduino boards or using the extended methods. The extended methods exploits the the SAM3X hardware and allows some interesting features like:

두에의 SPI인터페이스는 다른 아두이노 보드들과 다르게 작동한다. 다른 아두이노 보드들에서 이용가능한 동일한 메소드를 이용하거나  확장된 메소드들을 사용할 수 있다.

확장된 메소드들은 SAM3X 하드웨어를 최대한 이용하거나 다음과 같은 몇가지 흥미로운 기능들을 허용한다:

  • automatic handling of the device slave selection.
  • automatic handling of different device configurations (clock speed, data mode, etc) so every device can have its own configuration automatically selected.
  • 디바이스 슬레이브 선택의 자동 핸들링
  • 다른 디바이스 환경의 자동 핸들링(클럭스피드, 데이터모드, 등) 그러므로 모든 디바이스들은 자신의 환경을 자동으로 선택할 수 있다.

 

Arduino Due has three exposed pins for the devices Slave Select (SS) lines (pins 4, 10, and 52).

두에는 SS라인을 위한 3개의 노출된 핀을 가지고 있다(핀4, 10, 52).

 

Due Extended SPI usage

 

 

Functions

 

Examples

 

See also

 

Reference Home

 

Corrections, suggestions, and new documentation should be posted to the Forum.

 

The text of the Arduino reference is licensed under a Creative Commons Attribution-ShareAlike 3.0 License. Code samples in the reference are released into the public domain. 



'아두이노' 카테고리의 다른 글

아두이노 delay() 함수  (0) 2015.05.02
아두이노 millis() 함수  (0) 2015.05.02
HC-06 블루투스 모듈  (0) 2015.02.09
아두이노 타이머 인터럽트의 주의점 #3  (0) 2015.02.09
아두이노 타이머 인터럽트 사용#2  (0) 2015.02.09
posted by 래머
2015. 2. 22. 23:40 아두이노작품


각종 탱크 부품을 구하다가 발견한 신기한 녀석이다.

매우 흥미롭군 ㅎㅎ



일전에 제작한 탱크의 소스를 조금만 수정하면 정말 괜찮은 작품이 나올듯하다.


주문해서 도착한 스파이더 로봇

껍데기는 이렇게 생겼다.



열심히 조립하고, 정말 조립은 귀찮고 짜증나는 과정인듯하다.

이게 몸통이인데, 미리 드릴로 구멍을 뚫었다. 흔한 장난감용 모터 2개가 달려 있는데, 저번에 장난감

탱크의 모터와 비슷한게 힘이 별로 없을듯하다, 별로 마음에 안든다.




이건 다리다




두개를 결합하면 이렇게 된다.




기판을 고정시킬 포맥스 판을 정밀 제단하고,

한치의 오차도 없이 치수를 제어 구멍을 뚫었다.




기판위에 아두이노 나노를 고정시키고, 연결핀을 배치했다.




원래 눈이 있는곳인데, 여기에 초음파 센서를 글루건을 이용해서 고정시켰다.




전원은 이것 두개면 충분하겠지



AAA4개용 배터리 케이스다.




포맥스판과 스파이더로봇의 본체는 pCB서포트를 이용해서 고정하기로 했다.




음 이것들 다올라가면 또 탱크처럼 빌빌거리는거 아니겠지.


탱크때는 서보모터를 이용해서 장애물 검출 방향을 결정했었는데, 이번에는 힘들듯하여

생각하다, 지자기 센서를 이용해보기로 했다. 그나저나 너무 쪼그매서 어떻게 고정시키나. 생각해보니 핀도 잘못납땜한것같다. 핀이 아래쪽으로 향하게 해서 납떕했으면 기판위에 소켓만들고 바로 꽂을수 있었을텐데..



일단 소프트웨어 작업은 일차적으로 마무리 했는데, 주문한 모터 드라이버가 설이 끝나야 도착할거 같다.


완성된 작품은 차후에


-------2015-03-09----------------

모든 구성완료 후 테스트해보니, 모터가 힘이 없어서 빌빌....그냥망함 

스파이더로봇 프레임에 맞는 토크 높은 모터를 구해서 장착해봤지만 역시나 빌빌....한번더 망함

현존하는 어떠한 모터를 달아도 안될것같다. 결국 스파이더 로봇만들기는 포기를 했다.


대신에 스파이더 로봇구성을 위해 만들었던 회로는 2륜 구동 차량을 구매해서, 거기에 그대로 이식을 시켰다.

탱크를 만들면서 느낀거지만, 자동주행을 완벽하게 해보겠다고 센서를 덕지 덕지 붙였는데 결론은

헛짓거리였다는 것이다. 차량의 모든 방향을 커버할 수 있도록 센서를 촘촘하게 배치하지 않는 이상은 난해한 코스에서 무조건 해딩이다.

아래 이륜차는 하나의 초음파 센서만 장착했지만 탱크보다 훨씬 나아 보인다.






'아두이노작품' 카테고리의 다른 글

아두이노 4륜구동  (0) 2015.05.23
밸런싱 로봇 만들어 보기  (105) 2015.05.09
충전팩 충방전기 만들어보기  (1) 2015.04.27
라인트레이서 만들어보기  (1) 2015.03.25
아두이노 탱크 만들어보기  (0) 2015.02.22
posted by 래머
2015. 2. 22. 23:34 아두이노작품


탱크 자동주행 영상


아두이노라는 재미있는 녀석을 반결한 기념으로 탱크를 만들어보기로 했다.

조향가능한 RC카는 아무래도 제작하는데 더 힘들듯하니 만만한 탱크로...


일단 탱크 본체를 구해야 하는데, 만만한 녀석이 있나

마트 가서 보니 음 별로 없네..

그냥

이걸로 들고왔다.

크기가 좀 작은듯한데



음 조립하기 너무 귀찮은것같다. 아무튼 열심히 조립하고, 모터에 노이즈 감소용 세라믹 콘덴서를 납땜했다. 동시에 점퍼선도 납떔해주고..




상판에 튀어나온 부분은 칼로 썰어 버리고   서보모터를 달았다.



초음파센서로 장애물을 검출할수 있게 프라스틱 케이스에 글루건을 이용해서 고정시키고



다시 케이스를 서보모터에 고정시켰다.



모터를 제어할 모터 드라이버, ET-DCM이라는 모델인데

찾다찾다 없어서 구입한건데, 나중에 보니 다른것들도 많이 있었다. 내가 못찾은거였음..

아무튼 나름 쓸만한것 같다. 




쪼그만 프라스틱 케이스에 우노는 좀 큰것 같으니 나노를 구입해서 넣기로 했다.


일단 센서 테스트 ㅎㅎ

기본적인 작동 알고리즘은 센서에 일정이하의 거리가 검출되면 서보 모터를 조정해서 주변을 살펴서

회전 방향을 결정하는거다.



탱크의 모터와 서보모터에는 이녀석으로 전원을 공급하기로 했다.



탱크를 조정은 안드로이드 폰으로 하기로 했다.

하는일이 이거이니 만큼 유니티와 NGUI를 통해서 작업을.. 순수 안드로이드는 UI작업하기가 너무 귀찮은듯하다.




이렇게 해서 우여곡절끝에 일단 완성을..

음 근데 뭐지.. 왠지 탱크가 누더기 같다. 기분탓인가... 작동은 잘되는데

뭔가 좀...

그리고 서보모터는 왜 저렇게 튀지!! 

전진 후진은 잘되는데, 좌회전 우회전이 잘안된다.

모터 힘이 너무 없는것 같다.




자동주행시 서보 모터 제어가 정말 중요한 문제인데, 지 마음되로 튄다.

희안하게도 블루투스 연결만 되면 튀기 시작한다.

일단 해결은 잘됐지만, 이것때문에 몇일째 골머리릴 싸맸다.



뭔가 허무하다. 수십만원 투자해서 만든탱크인데, 누더기라니

차선책을 찾아야한다.

그와중에 이런녀석을 발견했다.

오호!! 힘좋게 생겼군. 일단 본체를 이것으로 바꾸기로 했다.



저번에 누더기 탱크를 교훈삼아, 이번에는 좀 제대로 만들어보기로 했는데,


일단 각종 기판들을 고정시킬 판때기가 필요하다.

재료를 알아보던중 알게된 포맥스 판때기다, 그전에 아크릴 판으로 치수재고 드릴로 구멍뚫다가 아작나는바람에 피눈물을 흘렸다.

이녀석은 가공도 쉽고 여로모로 아크릴판보다 좋은점이 많은것같다.



열심히 치수재고 드릴로 구멍뚫고..

초정밀 가공이란 바로 이런것인가(사실 아래 사진에 나온건 다른 작품에 사용할 판때기다 사진을 못찍어서.. 이걸로라도)




여기저기 널부러져 있던 부품들을 가능한 기판에 직접시키고




뭔가 매우 정밀해 보인다.



몇가지 기능을 추가할려다 보니, 다층 구조를 만들 수밖에 없었다.


초음파 센서의 단점을 보충해보고자 적외선 센서도 추가하기로 했다(사진이 없어서 좀 빌려옴).

탱크의 좌/우측 장애물을 검출하게 될것이다. 더불어 자동주행 알고리즘도 더욱 개선되었다.




이전에 아두이노에 전원을 공급하던 8.4V 니켈 수소 충전지는 너무 빨리 닳아서

이걸로 전원 공급을 대체 하기로 했다. 테스트결과 아주 넉넉하니 마음에 든다.



일반 USB케이블은 너무 뻑뻑해서, 요것도 같이 구매했다.



우연찬게 발견한 재미있는 녀석이다. 아주 조그만 모터와 프로팰러인데

무슨 쿼드콥터에 사용되는 녀석이라한다.

아무튼 마음에 들어서 구입했다.

어디에 쓸까 하다가 그냥 탱크의 뒷편에서 풍력을 공급하는 역할을 맡기기로 했다.




새로 구입한 ROVER-5 라는 녀석이 생각보다 전기를 엄청나게 잡아 먹는다.

1.2V AA충전지 4개로는 빌빌거린다, 더구나 모터 드라이버가 공급하는 전력이 최대 2A밖에(채널당 1A) 안되기 때문에 더욱더 힘을 못 받는다.

스펙상으로는 Rover 5의 각 모터는 최대 2.5A를 필요로 한다고 나와있다. 

그래서 일단은 1.2V충전지 6개를 연결하기로 하고, 서보모터와는 전원을 분리했다.

서보모터의 전원을 어떻게 공급할까 고민하다가 그냥 전원을 하나 더연결하기로 했다.


마침 집에서 놀고 있는 갤4 배터리가 있어서 이걸 활용하기로 했다.



완성품

사용하는 센서의 양이 많아져 3개의 아두이노 나노를 사용했다. 

A,B,C 3개의 아두이노가 A<->B간 i2c통신을 B<->C간 시리얼 통신을 하며, 데이터를 주고 받는다.

센서를 많이 달았지만, 장애물 검출 영역이 제한적이고 센서의 검출 조건도 제한 적이라

자동 주행시 애매한 조건에서 헤딩을 많이 한다. 결론은 센서로 해결하자면 끝이 없다는것.




탱크 수동조작 영상





posted by 래머
2015. 2. 9. 22:00 아두이노

스마트폰과아두이노를 연결시키는 가장손쉬운 방법은 블루투스 모듈사용인듯하다.

굉장히 유명한 놈이니 어떻게 사용하는지는 조금만 검색해봐도 자료들이 널려 있다.

소프트웨어 시리얼을 사용하는 방법과 하드웨어 시리얼을 사용하는 방법이 있는데,

흔히들 소프트웨어 시리얼을 이용해서 많이 사용하는듯하다.

나도 소프트 웨어 시리얼형태로 이용을 했었는데,

블루투스 통신때 서보모터가 틱틱 튀는 현상이 발생해서 몇일 고생하다가 하드웨어시리얼로 바꾸고 나서 문제가 사라졌다.

몇일 고생해가며 소프트웨어 시리얼 라이브러리 서보모터 제어 라이브러리 분석을 해보고나서 내린결론은 다음과 같다.

 

소프트웨어 시리얼과 서보제어 라이브러리는 둘다 인터럽트를 통해서 제어를 수행한다.

소프트웨어 시리얼 라이브러리 소스를 보면 데이터를 전송할때 전역 인터럽트 플래그를 켰다 껏다하게 된다. 만일 전역인터럽트 마스크가 클리어된다면 클리어된 시간동안은 다른 인터럽트가 수행될 수 없게 된다. 서보라이브러리는 타이머 인터럽트를 통해서 서보모터 제어 신호를 생성하는데

소프트웨어 시리얼이 write를 수행하면서 인터럽트를 꺼버리면 서보라이브러리의 타이머 인터럽트가 수행될 수 없게 되고, 결과적으로 서보라이브러리가 생성하는 서보모터 제어 PWM신호가 늘어지게 되고 서보모터가 튀는 형태로 나타나게 된다. 서보 모터가 튀는 현상을 관찰해보면 서보모터의 각도가 증가 하는 방향으로 튀는 현상을 볼 수 있는데, 역시 제때 PWM신호를 컨트롤 하지 못해서 PWM신호가 늘어졌다는것을 간접적으로 확인해주는것이다.

해결방법은 소프트웨어 시리얼과 서보모터 제어 라이브러리를 같이 쓰지 않는것이다.

 

posted by 래머
2015. 2. 9. 21:58 아두이노

아두이노 타이머를 공부 하다가 알게된 외국사이트입니다.

안되는 영어 실력이지만 도움이 되는것 같아 번역해 봅니다.
총6단계로 이루어진 내용이지만, 그중에서 가장핵심이 되는부분만 번역해봅니다.
원문 : http://www.instructables.com/id/Arduino-Timer-Interrupts/step6/Timer-and-Arduino-Functions/

Step 6: Timer and Arduino Functions(타이머와 아두이노함수들)

Picture of Timer and Arduino Functions
One last thing to note- certain timer setups will actually disable some of the Arduino library functions.  Timer0 is used by the functions millis() and delay(), if you manually set up timer0, these functions will not work correctly.
Additionally, all three timers underwrite the function analogWrite().  Manually setting up a timer will stop analogWrite() from working.
마지막으로 주의할점 - 어떠한 타이머 설정은 실제로 아두이노 라이브러리 함수를 무력화 시킨다. 타이머0은 함수 millis()와 delay()에 사용된다, 수동으로 타이머 0을 설정할경우, 이 함수들은 올바르게 작동하지 않을것이다.
게다가, 3개의 타이머들은 analogWrite()에서 쓰여지고 있으므로, 타이머 수동 설정은 analogWrite()함수의 작동을 멈추게 할것이다.

If there is some portion of your code that you don't want interrupted, considering using cli() and sei() to globally disable and enable interrupts.

코드의 일부분이 인터럽트 되기를 원하지 않을경우 cli()와 sei()를 사용함으로서 전체 인터럽트를 비활성/활성 시킬 수 있다.
You can read more about this on the Arduino website
Arduino website 에서 이것에 대해 좀더 볼 수 있다.


posted by 래머
2015. 2. 9. 21:58 아두이노

아두이노 타이머 인터럽트를 공부하다가 외국의 어느사이트에서 찾은 정보를 안되는 영어 실력이지만 살짝 번역해 보았습니다.

타이머 인터럽트 사용시 도움이 될듯합니다.
문제시 삭제 하겠습니다.

원문 : http://www.instructables.com/id/Arduino-Timer-Interrupts/step2/Structuring-Timer-Interrupts/


영어 실력이 좋지 못한 관계로 의역 및 오역이 있을 수 있습니다.


Picture of Structuring Timer Interrupts
IMG_9676 copy
IMG_9682 copy
Screen Shot 2013-04-17 at 2











Timer setup code is done inside the setup(){} function in an Arduino sketch.

타이머 셋업 코드는 아두이노 스케치의 setup() 함수 내에서 끝난다.

The code involved for setting up timer interrupts is a little daunting to look at, but it's actually not that hard.  I pretty much just copy the same main chunk of code and change the prescaler and compare match register to set the correct interrupt frequency.
포함된 타이머 인터럽트 셋팅 코드가, 보기에 조금은 어려울수도 있지만, 사실 전혀 어렵지 않다. 단지 올바른 인터럽트의 주파수를 설정하기 위해 프리스케일러와 비교 매치값 설정을 변경하는 동일한 메인 조각코드들을 조금 복사 했을 뿐이다.  
The main structure of the interrupt setup looks like this: 

인터럽트셋업의 주된 구조는 다음과 같다 : 

//http://www.instructables.com/id/Arduino-Timer-Interrupts/<br>void setup(){cli();//stop interrupts, 인터럽트를 멈춤//set timer0 interrupt at 2kHz, 타이머0을 2KHz로 설정  TCCR0A = 0;// set entire TCCR0A register to 0(TCCR0A레지스터를 0으로설정)  TCCR0B = 0;// same for TCCR0B(TCCR0B도 같음)  TCNT0  = 0;//initialize counter value to 0(카운터값을 0으로초기화)  // set compare match register for 2khz increments(비교매치 레지스터값을 2kHz증가로 설정)  OCR0A = 124;// = (16*10^6) / (2000*64) - 1 (must be <256)  // turn on CTC mode(CTC 모드 켜기)  TCCR0A |= (1 << WGM01);  // Set CS01 and CS00 bits for 64 prescaler(CS01과 CS00비트를 64프리스케일러로 설정 )  TCCR0B |= (1 << CS01) | (1 << CS00);     // enable timer compare interrupt(타이머 비교 인터럽트를 활성화시킴)  TIMSK0 |= (1 << OCIE0A);//set timer1 interrupt at 1Hz(타이머1을 1Hz로 설정)  TCCR1A = 0;// set entire TCCR1A register to 0  TCCR1B = 0;// same for TCCR1B  TCNT1  = 0;//initialize counter value to 0  // set compare match register for 1hz increments  OCR1A = 15624;// = (16*10^6) / (1*1024) - 1 (must be <65536)  // turn on CTC mode  TCCR1B |= (1 << WGM12);  // Set CS10 and CS12 bits for 1024 prescaler  TCCR1B |= (1 << CS12) | (1 << CS10);    // enable timer compare interrupt  TIMSK1 |= (1 << OCIE1A);//set timer2 interrupt at 8kHz  TCCR2A = 0;// set entire TCCR2A register to 0  TCCR2B = 0;// same for TCCR2B  TCNT2  = 0;//initialize counter value to 0  // set compare match register for 8khz increments  OCR2A = 249;// = (16*10^6) / (8000*8) - 1 (must be <256)  // turn on CTC mode  TCCR2A |= (1 << WGM21);  // Set CS21 bit for 8 prescaler  TCCR2B |= (1 << CS21);     // enable timer compare interrupt  TIMSK2 |= (1 << OCIE2A);sei();//allow interrupts}//end setup

Notice how the value of OCR#A (the compare match value) changes for each of these timer setups.  As explained in the last step, this was calculated according to the following equation:


각각의 타이머 설정을 위해 OCR#A(비교매치값)를 어떻게 설정하는지는 , 이전의 단계에서 설명했던것처럼, 다음의 방정식으로 계산된다.

compare match register = [ 16,000,000Hz/ (prescaler * desired interrupt frequency) ] - 1


remember that when you use timers 0 and 2 this number must be less than 256, and less than 65536 for timer1

기억해야할것은, 당신이 타이머 0과 2를 사용한다면, 이 값이 256보다 작아야 하며, 타이머1일경우 65536보다 작아야한다.

Also notice how the setups between the three timers differ slightly in the line which turns on CTC mode:

CTC모드를 켜기 위해 3개의 타이머 사이의 차이점은 다음과 같다 : 


TCCR0A |= (1 << WGM01);//for timer0
TCCR1B |= (1 << WGM12);//for timer1
TCCR2A |= (1 << WGM21);//for timer2
This follows directly from the datasheet of the ATMEL 328/168.


이것은 Atmel 328/168의 데이터시트를  직접적으로 얻었다.

Finally, notice how the setup for the prescalers follows the tables in the last step (the table for timer 0 is repeated above),

마지막으로, 이전 단계의 테이블에 나왔던 프리스케일러의 설정을 어떻게 하냐면(타이머 0의 것은 위에서 다시 보여주고 있다),
TCCR2B |= (1 << CS22);  // Set CS#2 bit for 64 prescaler for timer 2
TCCR1B |= (1 << CS11);  // Set CS#1 bit for 8 prescaler for timer 1
TCCR0B |= (1 << CS02) | (1 << CS00);  // Set CS#2 and CS#0 bits for 1024 prescaler for timer 0

Notice in the last step that there are different prescaling options for the different timers.  For example, timer2 does not have the option of 1024 prescaler.

이전 단계의 표에서 각 타이머들의 프리스케일링 옵션은 다르다. 예를들어  타이머2는 1024프리스케일러 옵션을 가지고 있지 않다.

The commands you want to execute during these timer interrupts are located in the Arduino sketch encapsulated in the following:

이들 타이머의 인터럽트 동안에 당신이 실행하기 원하는 명령들은 아두이노 스케치에 다음과 같이 요약되어 있다:
ISR(TIMER0_COMPA_vect){  //change the 0 to 1 for timer1 and 2 for timer2(타이머 1을위해서 0은 1로 타이머2인경우 0을 2로 바꿔라)
   //interrupt commands here
}
This bit of code should be located outside the setup() and loop() functions.  Also, try to keep the interrupt routine as short as possible, especially if you are interrupting at a high frequency.  It may even be worth addressing the ports/pins of the ATMEL chip directly instead of using the digitalWrite() and digitalRead() functions.  You can find more info about that here.

이 코드 조각은 setup()과 loop()의 밖에 위치한다. 특히 인터럽트가 고주기로 실행되는경우 인터럽트 루틴에 머무는 시간을 가능한 짧게 하도록 노력해라. 아트멜칩의 포트와 핀을 digitalWrite() 와 digitalRead()함수를 사용하기 보다는 직접적으로  어드래싱하는것도 한층 가치 있는일이다. 여기(here)에서 좀더 많은 정보를 찾을 수 있다.


Example- the following sketch sets up and executes 3 timer interrupts:

예제 - 다음의 스케치는 3개의 타이머 인터럽트를 설정하고 실행한다.
 

//timer interrupts//by Amanda Ghassaei//June 2012//http://www.instructables.com/id/Arduino-Timer-Interrupts//* * This program is free software; you can redistribute it and/or modify * it under the terms of the GNU General Public License as published by * the Free Software Foundation; either version 3 of the License, or * (at your option) any later version. 이프로그램은 무료소프트웨어다; 당신은 이것을 무료소프트웨어 토대로 배포된 GNU 일반 공중 라이센스 하에서 수정/재배포 가능하다; 라이센스버전3 또는 이후의 버전(당신이 선택한)
 **///timer setup for timer0, timer1, and timer2.//For arduino uno or any board with ATMEL 328/168.. diecimila, duemilanove, lilypad, nano, mini...//this code will enable all three arduino timer interrupts.//timer0 will interrupt at 2kHz//timer1 will interrupt at 1Hz//timer2 will interrupt at 8kHz//storage variablesboolean toggle0 = 0;boolean toggle1 = 0;boolean toggle2 = 0;void setup(){    //set pins as outputs  pinMode(8, OUTPUT);  pinMode(9, OUTPUT);  pinMode(13, OUTPUT);cli();//stop interrupts//set timer0 interrupt at 2kHz  TCCR0A = 0;// set entire TCCR2A register to 0  TCCR0B = 0;// same for TCCR2B  TCNT0  = 0;//initialize counter value to 0  // set compare match register for 2khz increments  OCR0A = 124;// = (16*10^6) / (2000*64) - 1 (must be <256)  // turn on CTC mode  TCCR0A |= (1 << WGM01);  // Set CS01 and CS00 bits for 64 prescaler  TCCR0B |= (1 << CS01) | (1 << CS00);     // enable timer compare interrupt  TIMSK0 |= (1 << OCIE0A);//set timer1 interrupt at 1Hz  TCCR1A = 0;// set entire TCCR1A register to 0  TCCR1B = 0;// same for TCCR1B  TCNT1  = 0;//initialize counter value to 0  // set compare match register for 1hz increments  OCR1A = 15624;// = (16*10^6) / (1*1024) - 1 (must be <65536)  // turn on CTC mode  TCCR1B |= (1 << WGM12);  // Set CS12 and CS10 bits for 1024 prescaler  TCCR1B |= (1 << CS12) | (1 << CS10);    // enable timer compare interrupt  TIMSK1 |= (1 << OCIE1A);//set timer2 interrupt at 8kHz  TCCR2A = 0;// set entire TCCR2A register to 0  TCCR2B = 0;// same for TCCR2B  TCNT2  = 0;//initialize counter value to 0  // set compare match register for 8khz increments  OCR2A = 249;// = (16*10^6) / (8000*8) - 1 (must be <256)  // turn on CTC mode  TCCR2A |= (1 << WGM21);  // Set CS21 bit for 8 prescaler  TCCR2B |= (1 << CS21);     // enable timer compare interrupt  TIMSK2 |= (1 << OCIE2A);sei();//allow interrupts}//end setupISR(TIMER0_COMPA_vect){//timer0 interrupt 2kHz toggles pin 8//generates pulse wave of frequency 2kHz/2 = 1kHz (takes two cycles for full wave- toggle high then toggle low)  if (toggle0){    digitalWrite(8,HIGH);    toggle0 = 0;  }  else{    digitalWrite(8,LOW);    toggle0 = 1;  }}ISR(TIMER1_COMPA_vect){//timer1 interrupt 1Hz toggles pin 13 (LED)//generates pulse wave of frequency 1Hz/2 = 0.5kHz (takes two cycles for full wave- toggle high then toggle low)  if (toggle1){    digitalWrite(13,HIGH);    toggle1 = 0;  }  else{    digitalWrite(13,LOW);    toggle1 = 1;  }}  ISR(TIMER2_COMPA_vect){//timer1 interrupt 8kHz toggles pin 9//generates pulse wave of frequency 8kHz/2 = 4kHz (takes two cycles for full wave- toggle high then toggle low)  if (toggle2){    digitalWrite(9,HIGH);    toggle2 = 0;  }  else{    digitalWrite(9,LOW);    toggle2 = 1;  }}void loop(){  //do other things here}


The images above show the outputs from these timer interrupts.  Fig 1 shows a square wave oscillating between 0 and 5V at 1kHz (timer0 interrupt), fig 2 shows the LED attached to pin 13 turning on for one second then turning off for one second (timer1 interrupt),  fig 3 shows a pulse wave oscillating between 0 and 5V at a frequency of 4khz (timer2 interrupt).

위의 이미지는 이들 타이머 인터럽트들로 부터의 출력을 보여준다. Fig1은 1KHz의 0 ~ 5V로 진동하는 직각파를 보여준다(타이머 0 인터럽트),

fig2는 LED가 결합된 13번핀이 1초동안 켜지고 1초동안 꺼지는 것을 보여주며(타이머1 인터럽트), fig3은 4KHz로 진동하는 0 ~ 5V의 펄스 웨이브를 보여준다(타이머2 인터럽트).


posted by 래머
2015. 2. 9. 21:57 아두이노

아두이노 타이머 인터럽트에 대해서 공부하다가, 외국의 어떤 사이트자료가 있어

안된는 영어 실력이지만 번역해 보았습니다. 아두이노 타이머 인터럽트 이해에 도움이 될듯합니다.
문제가 된다면 삭제하도록하겠습니다.

원문 : http://www.instructables.com/id/Arduino-Timer-Interrupts/step1/Prescalers-and-the-Compare-Match-Register/


영어 실력이 좋지 못한 관계로 의역 및 오역이 있을수 있습니다.


Picture of Prescalers and the Compare Match Register
Screen Shot 2013-04-17 at 2
Screen Shot 2013-04-17 at 2




The Uno has three timers called timer0, timer1, and timer2.  Each of the timers has a counter that is incremented on each tick of the timer's clock.  CTC timer interrupts are triggered when the counter reaches a specified value, stored in the compare match register.  Once a timer counter reaches this value it will clear (reset to zero) on the next tick of the timer's clock, then it will continue to count up to the compare match value again.  By choosing the compare match value and setting the speed at which the timer increments the counter, you can control the frequency of timer interrupts.
우노는 timer0, timer1, timer2라 불려지는 3개의 타이머를 가지고 있다. 각각의 타이머는 타이머 클럭틱마다 증가하는 카운터를 가지고 있다. CTC타이머 인터럽트는 카운터가 비교 매치 레지스터에 저장된 값에 도달할때 트리거된다. 일단 타이머 카운터가 이값에 도달하면, 타이머의 다음 클럭틱 때에 클리어(0으로 초기화)되고 ,  카운트 매치값  비교가 다시 진행될 것이다. 
비교매치값과 각 타이머가 카운터를 증가 시키는 속도를 선택하는 것으로, 당신은 타이머 인터럽트의 빈도를 제어할 수 있다.

The first parameter I'll discuss is the speed at which the timer increments the counter.  The Arduino clock runs at 16MHz, this is the fastest speed that the timers can increment their counters.  At 16MHz each tick of the counter represents 1/16,000,000 of a second (~63ns), so a counter will take 10/16,000,000 seconds to reach a value of 9 (counters are 0 indexed), and 100/16,000,000 seconds to reach a value of 99.
첫번째로 논의될 파라메터는 타이머가 카운터를 증가시키는 속도이다. 아두이노는 16Mhz 클럭으로 실행되고, 이것은 타이머가 그것의 카운터를 증가 시킬 수 있는 가장 빠른속도이다. 16MHz에서 카운터의 각 틱은 1/16,000,000초(약 63나노초)로 표현된다, 그러므로 카운터는 10/16,000,000초에 9의 값에 도달(카운터는 0에서 시작함)하고, 100/16,000,000초에는 99에 도달할 것이다.

In many situations, you will find that setting the counter speed to 16MHz is too fast.  Timer0 and timer2 are 8 bit timers, meaning they can store a maximum counter value of 255.  Timer1 is a 16 bit timer, meaning it can store a maximum counter value of 65535.  Once a counter reaches its maximum, it will tick back to zero (this is called overflow).  This means at 16MHz, even if we set the compare match register to the max counter value, interrupts will occur every 256/16,000,000 seconds (~16us) for the 8 bit counters, and every 65,536/16,000,000 (~4 ms) seconds for the 16 bit counter.  Clearly, this is not very useful if you only want to interrupt once a second.

많은 부분에서, 당신은 카운터를 16MHz 속도로 설정하는것은 너무 빠르다는것을 알 수있을 것이다. Timer0와 Timer2는 8비트 타이머이다, 이것은 카운터들이 최대 255의 값을 저장할 수 있다는것을 의미한다. Timer1은 16비트 타이머이다. 이것은 카운터가 최대 65535의 값을 저장할 수 있다는 의미다. 일단 카운터가 최대값에 도달하면, 다시 0으로 돌아갈 것이다(오버플로우라 불린다).  이것은 16MHz에서, 우리가 비교매치 레지스터에 최대 카운터 값을 기록할경우,  인터럽트는 8비트 타이머에서는 매 256/16,000,000 초(약 16마이크로초) 마다 발생하고 16비트 타이머에서는 매 65,536/16,000,000(약 4밀리초)초마다 발생한다는 의미다. 확실히, 이부분은 당신이 매초마다 한번 인터럽트를 원하는 경우에 전혀 유용하지 않다.

Instead you can control the speed of the timer counter incrementation by using something called a prescaler.  A prescaler dictates the speed of your timer according the the following equation:
대신에 프리스케일러(prescaler)라 불려지는 어떠한 것을 통해서 타이머 카운터의 증가 속도를 제어할 수 있다.프리스케일러는 다음의 방정식에 따라서 타이머의 속도를 지정한다.

(timer speed (Hz)) = (Arduino clock speed (16MHz)) / prescaler
(타이머속도(헤르츠)) = (아두이노 클럭속도(16메가헤르츠)) / 프리스케일러

So a 1 prescaler will increment the counter at 16MHz, an 8 prescaler will increment it at 2MHz, a 64 prescaler = 250kHz, and so on.  As indicated in the tables above, the prescaler can equal 1, 8, 64, 256, and 1024.  (I'll explain the meaning of CS12, CS11, and CS10 in the next step.) 
그러므로 1프리스케일러에서 카운터는 16MHz씩 증가하고, 8프리스케일러에서 2MHz, 64프리스케일러에서 = 250KHz, 와 같은 식으로 증가할 것이다. 위의 테이블에서 나타낸것처럼, 프리스케일러는 1, 8, 64, 256, 1024의 값이 될 수 있다.(다음스텝에서 CS12, CS11, CS10에 대해서 설명할 것이다)

Now you can calculate the interrupt frequency with the following equation:
다음의 방정식으로 당신은 인터럽트의 주기를 계산할 수있다.

interrupt frequency (Hz) = (Arduino clock speed 16,000,000Hz) / (prescaler * (compare match register + 1))

인터럽트주기(Hz) = (아두이노클럭(16MHz) / (프리스케일러 * (compare match 레지스터 값 + 1))

the +1 is in there because the compare match register is zero indexed
+1을 하는 이유는 비교 매치 레지스터가 0부터 시작하기 때문이다.

rearranging the equation above, you can solve for the compare match register value that will give your desired interrupt frequency:
위의 방정식을 다시 정리하면, 당신이 요구하는 인터럽트의 주기를 결정하는 비교 매치 레지스터의 값을 알 수있다.

compare match register = [ 16,000,000Hz/ (prescaler * desired interrupt frequency) ] - 1
비교 매치레지스터 값 = [16Mhz / (프리스케일러 * 요구하는 주파수)] - 1
remember that when you use timers 0 and 2 this number must be less than 256, and less than 65536 for timer1
타이머0과 타이머2에서 이값은(비교매치값) 256보다 작아야하며, 타이머1에서는 65536보다 작아야한다는것을 기억하라.

so if you wanted an interrupt every second (frequency of 1Hz):
compare match register = [16,000,000 / (prescaler * 1) ] -1
with a prescaler of 1024 you get:
compare match register = [16,000,000 / (1024 * 1) ] -1
= 15,624
since 256 < 15,624 < 65,536, you must use timer1 for this interrupt.
그렇기 때문에 매초마다 인터럽트를 원한다면(1Hz주파수) : 
비교매치값 = (16MHz / (프리스케일러 * 1)) - 1 에서 프리스케일러가 1024라면
비교매치값 = (16MHz / (1024 * 1)) - 1 = 15,624
256 < 15,624 < 65,536 이므로, 당신은 반드시 타이머1의 인터럽트를 사용해야한다.


'아두이노' 카테고리의 다른 글

SPI library  (0) 2015.02.23
HC-06 블루투스 모듈  (0) 2015.02.09
아두이노 타이머 인터럽트의 주의점 #3  (0) 2015.02.09
아두이노 타이머 인터럽트 사용#2  (0) 2015.02.09
analogWrite 함수  (0) 2015.02.09
posted by 래머
2015. 2. 9. 21:56 아두이노

원문 : http://arduino.cc/en/Reference/AnalogWrite

Description

Writes an analog value (PWM wave) to a pin. 

아날로그 값(PWM 웨이브)을 쓴다.

Can be used to light a LED at varying brightnesses or drive a motor at various speeds. 

LED의 동적인 밝기 또는 모터를 동적인 속도로 운행하는데 사용할 수 있다.

After a call to analogWrite(), the pin will generate a steady square wave of the specified duty cycle until the next call to analogWrite() (or a call to digitalRead() or digitalWrite() on the same pin). 

analogWrite()호출 후, 핀에는 지정된 듀티사이클의 안정된 직각파형이 생성되며, 같은핀에 analogWrite()가(또는  

digitalRead()나 digitalWrite()가 호출될때) 다시 호출되기 전까지 유지된다.

The frequency of the PWM signal on most pins is approximately 490 Hz. 

대부분의 핀에서 PWM신호의 주파수는 약 490Hz이다.

On the Uno and similar boards, pins 5 and 6 have a frequency of approximately 980 Hz. 

우노나 유사한 보드들에서, 5, 6번핀은 주파수가 대략 980Hz이다.

Pins 3 and 11 on the Leonardo also run at 980 Hz.

레오나르도에서는 3번과 11번핀 역시 980Hz이다.

On most Arduino boards (those with the ATmega168 or ATmega328), this function works on pins 3, 5, 6, 9, 10, and 11. 

대부분의 아두이노 보드들에서(Atmega168또는 Atmega328 같은), 이함수는 3, 5, 6, 9, 10, 11번핀에서 작동한다.

On the Arduino Mega, it works on pins 2 - 13 and 44 - 46. 

아두이노 메가에서, 이함수는 2 ~ 13번핀 및 44 ~ 46번핀에 작동한다.

Older Arduino boards with an ATmega8 only support analogWrite() on pins 9, 10, and 11.

Atmega8과 같은 이전의 아두이노보드들에서 analogWrite()함수는 오직 9, 10, 11번핀만 지원한다.

The Arduino Due supports analogWrite() on pins 2 through 13, plus pins DAC0 and DAC1

아두이노 두에에서 analogWrite()는 2 ~ 13번 및 DAC0와 DAC1을 지원한다.

Unlike the PWM pins, DAC0 andDAC1 are Digital to Analog converters, and act as true analog outputs.

PWM핀들과 다르게, DAC0와 DAC1은 디지털 아날로그 변환기이며, 실제로 아날로그 출력을 만든다.

You do not need to call pinMode() to set the pin as an output before calling analogWrite().

analogWrite()를 호출하기 전에 pinMode()를 호출해서 핀을 출력으로 설정할 필요는 없다.

The analogWrite function has nothing to do with the analog pins or the analogRead function.

analogWrite함수는 아날로그 핀이나 analogRead함수와는 전혀관련없다.

Syntax(문법)

analogWrite(pin, value)

Parameters(인자들)

pin: the pin to write to.(사용할 핀)

value: the duty cycle: between 0 (always off) and 255 (always on).

값 : 듀티사이클 : 0(항상꺼짐) ~ 255(항상켜짐)사이의 값

Returns(결과값)

nothing

Notes and Known Issues(알려진 이슈)

The PWM outputs generated on pins 5 and 6 will have higher-than-expected duty cycles. 

5, 6번핀에서 생성되는 PWM출력은 의도했던것보더 높은 듀티사이클을 가질 것이다.

This is because of interactions with the millis() and delay() functions, which share the same internal timer used to generate those PWM outputs. 

이것은 millis()나 delay()함수들과의 상호작용때문으로, PWM출력생성에 내부 타이머를 공유하기 때문이다.

This will be noticed mostly on low duty-cycle settings (e.g 0 - 10) and may result in a value of 0 not fully turning off the output on pins 5 and 6.

이것은 대부분 낮은 듀티 사이클 설정(예를들어 0 ~10)에서 주의 를 요하며, 결과적으로 0의값 설정은 5, 6번핀을 완전히 끄지 못한다.

Example

Sets the output to the LED proportional to the value read from the potentiometer.

전위차계로 부터 읽은 값에 비례하여 LED출력을 설정

 
int ledPin = 9;      // LED connected to digital pin 9
int analogPin = 3;   // potentiometer connected to analog pin 3
int val = 0;         // variable to store the read value

void setup()
{
  pinMode(ledPin, OUTPUT);   // sets the pin as output
}

void loop()
{
  val = analogRead(analogPin);   // read the input pin
  analogWrite(ledPin, val / 4);  // analogRead values go from 0 to 1023, analogWrite values from 0 to 255
}

See also

Reference Home

Corrections, suggestions, and new documentation should be posted to the Forum.

The text of the Arduino reference is licensed under a Creative Commons Attribution-ShareAlike 3.0 License. Code samples in the reference are released into the public domain.

posted by 래머