Page 289 - 2
P. 289
#define DIR_BACKWARD 2
#define DELAY 3
int dht11_dat[5] = { 0, 0, 0, 0, 0 };
int g_direction = DIR_STOP;
int g_current = MIN;
int sw = 0;
// 스텝모터관련
void setsteps(int w1, int w2, int w3, int w4)
{
pinMode(STEP1, OUTPUT);
digitalWrite(STEP1, w1);
pinMode(STEP2, OUTPUT);
digitalWrite(STEP2, w2);
pinMode(STEP3, OUTPUT);
digitalWrite(STEP3, w3);
pinMode(STEP4, OUTPUT);
digitalWrite(STEP4, w4);
}
void rotateOneStep(int direction)
{
if (direction == DIR_FORWARD)
{
setsteps(1, 1, 0, 0);
delay(DELAY);
setsteps(0, 1, 1, 0);
delay(DELAY);
setsteps(0, 0, 1, 1);
delay(DELAY);
setsteps(1, 0, 0, 1);
delay(DELAY);
g_current++;
}
else
{
setsteps(1, 0, 0, 1);
delay(DELAY);
setsteps(0, 0, 1, 1);
delay(DELAY);
setsteps(0, 1, 1, 0);
delay(DELAY);
setsteps(1, 1, 0, 0);
delay(DELAY);
- 289 -