refactoring
This commit is contained in:
159
src/clock.c
Normal file
159
src/clock.c
Normal file
@ -0,0 +1,159 @@
|
||||
#include <stdint.h>
|
||||
#include <avr/io.h>
|
||||
#include <avr/interrupt.h>
|
||||
|
||||
#include "clock.h"
|
||||
|
||||
|
||||
volatile clock_t clock;
|
||||
volatile opTime_t opTime;
|
||||
|
||||
volatile uint8_t useLocalClock = 1;
|
||||
|
||||
volatile uint8_t nextSecond = 0;
|
||||
volatile uint8_t nextMinute = 0;
|
||||
|
||||
ISR(TIMER2_OVF_vect) {
|
||||
clock.second++;
|
||||
nextSecond = 1;
|
||||
|
||||
if (useLocalClock == 1) {
|
||||
if (clock.second >= 60) {
|
||||
clock.second = 0;
|
||||
clock.minute++;
|
||||
|
||||
nextMinute = 1;
|
||||
}
|
||||
if (clock.minute >= 60) {
|
||||
clock.minute = 0;
|
||||
clock.hour++;
|
||||
}
|
||||
if (clock.hour >= 24) {
|
||||
clock.hour = 0;
|
||||
}
|
||||
}
|
||||
|
||||
opTime.second++;
|
||||
|
||||
if (opTime.second >= 60) {
|
||||
opTime.second = 0;
|
||||
opTime.minute++;
|
||||
}
|
||||
if (opTime.minute >= 60) {
|
||||
opTime.minute = 0;
|
||||
opTime.hour++;
|
||||
}
|
||||
if (opTime.hour >= 24) {
|
||||
opTime.hour = 0;
|
||||
}
|
||||
}
|
||||
|
||||
void clockInit() {
|
||||
clock.hour = 0;
|
||||
clock.minute = 0;
|
||||
clock.second = 0;
|
||||
|
||||
opTime.hour = 0;
|
||||
opTime.minute = 0;
|
||||
opTime.second = 0;
|
||||
|
||||
// seconds
|
||||
TCCR2 = 0b00000101;
|
||||
ASSR |= (1 << AS2);
|
||||
TIMSK |= (1 << TOIE2) | (1 << TICIE1);
|
||||
|
||||
// heartbeat
|
||||
TCCR0 = (1 << CS02) | (1 << CS00);
|
||||
TIMSK |= (1 << TOIE0);
|
||||
}
|
||||
|
||||
opTime_t clockGetOpTime() {
|
||||
return opTime;
|
||||
}
|
||||
|
||||
void clockSetUseLocalClock(uint8_t x) {
|
||||
useLocalClock = x;
|
||||
}
|
||||
|
||||
void clockSetClock(uint8_t year, uint8_t month, uint8_t day, uint8_t weekday, uint8_t hour, uint8_t minute) {
|
||||
cli();
|
||||
clock.year = year;
|
||||
clock.month = month;
|
||||
clock.day = day;
|
||||
clock.weekday = weekday;
|
||||
clock.hour = hour;
|
||||
clock.minute = minute;
|
||||
sei();
|
||||
}
|
||||
|
||||
void clockClearSecond() {
|
||||
cli();
|
||||
clock.second = 0;
|
||||
sei();
|
||||
}
|
||||
|
||||
clock_t clockGetClock() {
|
||||
cli();
|
||||
clock_t c = clock;
|
||||
sei();
|
||||
return c;
|
||||
}
|
||||
|
||||
uint8_t clockNextSecond() {
|
||||
if (nextSecond != 0) {
|
||||
nextSecond = 0;
|
||||
return 1;
|
||||
} else {
|
||||
return 0;
|
||||
}
|
||||
}
|
||||
|
||||
uint8_t clockNextMinute() {
|
||||
if (nextMinute != 0) {
|
||||
nextMinute = 0;
|
||||
return 1;
|
||||
} else {
|
||||
return 0;
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
volatile uint8_t tack = 0;
|
||||
volatile uint8_t step = 0;
|
||||
|
||||
|
||||
uint8_t clockNextStep() {
|
||||
if (step != 0) {
|
||||
step = 0;
|
||||
return 1;
|
||||
} else {
|
||||
return 0;
|
||||
}
|
||||
}
|
||||
|
||||
uint8_t clockNextTack() {
|
||||
if (tack != 0) {
|
||||
tack = 0;
|
||||
return 1;
|
||||
} else {
|
||||
return 0;
|
||||
}
|
||||
}
|
||||
|
||||
ISR(TIMER0_OVF_vect) {
|
||||
static uint8_t subDivTack = 0;
|
||||
subDivTack++;
|
||||
if (subDivTack >= SUB_DIV_LED) {
|
||||
subDivTack = 0;
|
||||
tack = 1;
|
||||
}
|
||||
|
||||
static uint8_t subDivStepper = 0;
|
||||
subDivStepper++;
|
||||
if (subDivStepper >= SUB_DIV_STEPPER) {
|
||||
subDivStepper = 0;
|
||||
step = 1;
|
||||
}
|
||||
}
|
||||
|
||||
|
43
src/clock.h
Normal file
43
src/clock.h
Normal file
@ -0,0 +1,43 @@
|
||||
#ifndef CLOCK_H_
|
||||
#define CLOCK_H_
|
||||
|
||||
#include <stdint.h>
|
||||
|
||||
|
||||
#define SUB_DIV_LED 30
|
||||
#define SUB_DIV_STEPPER 3
|
||||
|
||||
|
||||
typedef struct clock_s {
|
||||
uint8_t hour;
|
||||
uint8_t minute;
|
||||
uint8_t second;
|
||||
uint8_t day;
|
||||
uint8_t weekday;
|
||||
uint8_t month;
|
||||
uint8_t year;
|
||||
} clock_t;
|
||||
|
||||
typedef struct opTime_s {
|
||||
uint8_t second;
|
||||
uint8_t minute;
|
||||
uint16_t hour;
|
||||
} opTime_t;
|
||||
|
||||
|
||||
void clockInit();
|
||||
opTime_t clockGetOpTime();
|
||||
|
||||
uint8_t clockNextStep();
|
||||
uint8_t clockNextTack();
|
||||
uint8_t clockNextSecond();
|
||||
uint8_t clockNextMinute();
|
||||
|
||||
void clockSetUseLocalClock(uint8_t x);
|
||||
void clockClearSecond();
|
||||
void clockSetClock(uint8_t year, uint8_t month, uint8_t day, uint8_t weekday, uint8_t hour, uint8_t minute);
|
||||
clock_t clockGetClock();
|
||||
|
||||
|
||||
|
||||
#endif /* CLOCK_H_ */
|
391
src/main.c
391
src/main.c
@ -3,101 +3,30 @@
|
||||
#include <avr/interrupt.h>
|
||||
#include <util/delay.h>
|
||||
|
||||
#include "main.h"
|
||||
#include "clock.h"
|
||||
#include "uartdrv.h"
|
||||
#include "stepper.h"
|
||||
#include "validLed.h"
|
||||
|
||||
|
||||
#define START_GAP_MIN 1500
|
||||
#define ONE_WIDTH_MIN 170
|
||||
#define ONE_WIDTH_MAX 260
|
||||
#define ZERO_WIDTH_MIN 70
|
||||
#define ZERO_WIDTH_MAX 150
|
||||
|
||||
#define SUB_DIV_LED 30
|
||||
#define SUB_DIV_STEPPER 3
|
||||
|
||||
#define STEPS_PER_MINUTE 3
|
||||
#define STEPS_PER_HOUR 7
|
||||
|
||||
|
||||
typedef struct receivedData_s {
|
||||
uint8_t minuteDigit0;
|
||||
uint8_t minuteDigit1;
|
||||
uint8_t minuteOneCnt;
|
||||
uint8_t hourDigit0;
|
||||
uint8_t hourDigit1;
|
||||
uint8_t hourOneCnt;
|
||||
uint8_t dayDigit0;
|
||||
uint8_t dayDigit1;
|
||||
uint8_t weekdayDigit0;
|
||||
uint8_t monthDigit0;
|
||||
uint8_t monthDigit1;
|
||||
uint8_t yearDigit0;
|
||||
uint8_t yearDigit1;
|
||||
uint8_t dateOneCnt;
|
||||
} receivedData_t;
|
||||
|
||||
typedef struct clock_s {
|
||||
uint8_t hour;
|
||||
uint8_t minute;
|
||||
uint8_t second;
|
||||
uint8_t day;
|
||||
uint8_t weekday;
|
||||
uint8_t month;
|
||||
uint8_t year;
|
||||
} clock_t;
|
||||
|
||||
typedef struct opTime_s {
|
||||
uint8_t second;
|
||||
uint8_t minute;
|
||||
uint16_t hour;
|
||||
} opTime_t;
|
||||
|
||||
|
||||
receivedData_t rd;
|
||||
|
||||
volatile clock_t clock;
|
||||
volatile opTime_t opTime;
|
||||
extern volatile clock_t clock;
|
||||
|
||||
volatile uint8_t tick;
|
||||
volatile uint16_t captValue = 0;
|
||||
volatile uint16_t gapValue = 0;
|
||||
volatile uint8_t valid = 0;
|
||||
volatile uint8_t tack = 0;
|
||||
volatile uint8_t step = 0;
|
||||
uint16_t validCnt = 0;
|
||||
uint16_t timeValidCnt = 0;
|
||||
|
||||
extern uint8_t bufferReadIdx;
|
||||
extern uint8_t bufferWriteIdx;
|
||||
|
||||
ISR(TIMER2_OVF_vect) {
|
||||
clock.second++;
|
||||
|
||||
if (valid != 2) {
|
||||
if (clock.second >= 60) {
|
||||
clock.second = 0;
|
||||
clock.minute++;
|
||||
}
|
||||
if (clock.minute >= 60) {
|
||||
clock.minute = 0;
|
||||
clock.hour++;
|
||||
}
|
||||
if (clock.hour >= 24) {
|
||||
clock.hour = 0;
|
||||
}
|
||||
}
|
||||
|
||||
opTime.second++;
|
||||
|
||||
if (opTime.second >= 60) {
|
||||
opTime.second = 0;
|
||||
opTime.minute++;
|
||||
}
|
||||
if (opTime.minute >= 60) {
|
||||
opTime.minute = 0;
|
||||
opTime.hour++;
|
||||
}
|
||||
if (opTime.hour >= 24) {
|
||||
opTime.hour = 0;
|
||||
}
|
||||
}
|
||||
|
||||
ISR(INT0_vect) {
|
||||
uint16_t tmpCnt = TCNT1;
|
||||
@ -110,40 +39,26 @@ ISR(INT1_vect) {
|
||||
tick = 1;
|
||||
}
|
||||
|
||||
ISR(TIMER0_OVF_vect) {
|
||||
static uint8_t subDivTack = 0;
|
||||
subDivTack++;
|
||||
if (subDivTack >= SUB_DIV_LED) {
|
||||
subDivTack = 0;
|
||||
tack = 1;
|
||||
|
||||
void setValid(uint8_t x) {
|
||||
valid = x;
|
||||
if (valid == 1) {
|
||||
validCnt++;
|
||||
clockSetUseLocalClock(1);
|
||||
} else if (valid == 2) {
|
||||
timeValidCnt++;
|
||||
clockSetUseLocalClock(0);
|
||||
stepperEnable();
|
||||
} else {
|
||||
clockSetUseLocalClock(1);
|
||||
}
|
||||
}
|
||||
|
||||
static uint8_t subDivStepper = 0;
|
||||
subDivStepper++;
|
||||
if (subDivStepper >= SUB_DIV_STEPPER) {
|
||||
subDivStepper = 0;
|
||||
step = 1;
|
||||
}
|
||||
uint8_t getValid() {
|
||||
return valid;
|
||||
}
|
||||
|
||||
int main() {
|
||||
uartdrvInit();
|
||||
|
||||
clock.hour = 0;
|
||||
clock.minute = 0;
|
||||
clock.second = 0;
|
||||
|
||||
opTime.hour = 0;
|
||||
opTime.minute = 0;
|
||||
opTime.second = 0;
|
||||
|
||||
|
||||
|
||||
|
||||
// seconds
|
||||
TCCR2 = 0b00000101;
|
||||
ASSR |= (1 << AS2);
|
||||
TIMSK |= (1 << TOIE2) | (1 << TICIE1);
|
||||
|
||||
// signal measurment
|
||||
TCCR1A = 0;
|
||||
@ -158,35 +73,13 @@ int main() {
|
||||
// esd prot
|
||||
DDRD |= (1 << PD5) | (1 << PD6);
|
||||
|
||||
// valid led
|
||||
DDRB |= (1 << PB0);
|
||||
TCCR0 = (1 << CS02) | (1 << CS00);
|
||||
TIMSK |= (1 << TOIE0);
|
||||
|
||||
// position switches
|
||||
DDRB &= ~(1 << PB1);
|
||||
DDRB &= ~(1 << PB2);
|
||||
PORTB |= (1 << PB1) | (1 << PB2);
|
||||
uartdrvInit();
|
||||
clockInit();
|
||||
stepperInit();
|
||||
validLedInit();
|
||||
|
||||
// dark switch
|
||||
DDRD &= ~(1 << PD7);
|
||||
PORTD |= (1 << PD7);
|
||||
|
||||
// stepper
|
||||
DDRC |= (1 << PC4) | (1 << PC3) | (1 << PC2) | (1 << PC1) | (1 << PC0);
|
||||
DDRA |= (1 << PA0) | (1 << PA1);
|
||||
|
||||
PORTC &= ~(1 << PC3);
|
||||
PORTC &= ~(1 << PC2);
|
||||
PORTC &= ~(1 << PC1);
|
||||
PORTC &= ~(1 << PC0);
|
||||
|
||||
PORTA &= ~(1 << PA0);
|
||||
PORTA &= ~(1 << PA1);
|
||||
|
||||
PORTC &= ~(1 << PC4);
|
||||
_delay_ms(1);
|
||||
PORTC |= (1 << PC4);
|
||||
setValid(0);
|
||||
|
||||
sei();
|
||||
|
||||
@ -195,9 +88,6 @@ int main() {
|
||||
|
||||
uint8_t bit = 0;
|
||||
uint8_t state = 0;
|
||||
uint16_t validCnt = 0;
|
||||
uint16_t timeValidCnt = 0;
|
||||
uint8_t ledToggle = 0;
|
||||
|
||||
|
||||
while (1) {
|
||||
@ -209,11 +99,10 @@ int main() {
|
||||
|
||||
if (gap > START_GAP_MIN) {
|
||||
if (valid == 0) {
|
||||
validCnt++;
|
||||
valid = 1;
|
||||
setValid(1);;
|
||||
}
|
||||
state = 0;
|
||||
clock.second = 0;
|
||||
clockClearSecond();
|
||||
}
|
||||
|
||||
if (pulse > ZERO_WIDTH_MIN && pulse < ZERO_WIDTH_MAX) {
|
||||
@ -222,7 +111,7 @@ int main() {
|
||||
bit = 1;
|
||||
} else {
|
||||
bit = 2;
|
||||
valid = 0;
|
||||
setValid(0);;
|
||||
}
|
||||
|
||||
|
||||
@ -230,7 +119,7 @@ int main() {
|
||||
switch (state) {
|
||||
case 0:
|
||||
if (bit != 0)
|
||||
valid = 0;
|
||||
setValid(0);
|
||||
break;
|
||||
case 1:
|
||||
break;
|
||||
@ -272,7 +161,7 @@ int main() {
|
||||
break;
|
||||
case 20:
|
||||
if (bit != 1)
|
||||
valid = 0;
|
||||
setValid(0);
|
||||
break;
|
||||
case 21:
|
||||
rd.minuteOneCnt = 0;
|
||||
@ -316,7 +205,7 @@ int main() {
|
||||
rd.minuteOneCnt += bit;
|
||||
if (rd.minuteOneCnt % 2 != 0) {
|
||||
printf("MINUTE INVALID\n");
|
||||
valid = 0;
|
||||
setValid(0);
|
||||
} else {
|
||||
printf("MINUTE %u %u\n", rd.minuteDigit0, rd.minuteDigit1);
|
||||
}
|
||||
@ -358,7 +247,7 @@ int main() {
|
||||
rd.hourOneCnt += bit;
|
||||
if (rd.hourOneCnt % 2 != 0) {
|
||||
printf("HOUR INVALID\n");
|
||||
valid = 0;
|
||||
setValid(0);
|
||||
} else {
|
||||
printf("HOUR %u %u\n", rd.hourDigit0, rd.hourDigit1);
|
||||
}
|
||||
@ -485,23 +374,21 @@ int main() {
|
||||
rd.dateOneCnt += bit;
|
||||
if (rd.dateOneCnt % 2 != 0) {
|
||||
printf("DATE INVALID\n");
|
||||
valid = 0;
|
||||
setValid(0);
|
||||
} else {
|
||||
printf("DAY %u %u\n", rd.dayDigit0, rd.dayDigit1);
|
||||
printf("WEEKDAY %u\n", rd.weekdayDigit0);
|
||||
printf("MONTH %u %u\n", rd.monthDigit0, rd.monthDigit1);
|
||||
printf("YEAR %u %u\n", rd.yearDigit0, rd.yearDigit1);
|
||||
|
||||
clock.minute = rd.minuteDigit0 + rd.minuteDigit1 * 10;
|
||||
clock.hour = rd.hourDigit0 + rd.hourDigit1 * 10;
|
||||
clock.day = rd.dayDigit0 + rd.dayDigit1 * 10;
|
||||
clock.weekday = rd.weekdayDigit0;
|
||||
clock.month = rd.monthDigit0 + rd.monthDigit1 * 10;
|
||||
clock.year = rd.yearDigit0 + rd.yearDigit1 * 10;
|
||||
clockSetClock(rd.yearDigit0 + rd.yearDigit1 * 10,
|
||||
rd.monthDigit0 + rd.monthDigit1 * 10,
|
||||
rd.dayDigit0 + rd.dayDigit1 * 10,
|
||||
rd.weekdayDigit0,
|
||||
rd.hourDigit0 + rd.hourDigit1 * 10,
|
||||
rd.minuteDigit0 + rd.minuteDigit1 * 10);
|
||||
|
||||
|
||||
valid = 2;
|
||||
timeValidCnt++;
|
||||
setValid(2);
|
||||
}
|
||||
break;
|
||||
case 59:
|
||||
@ -511,202 +398,32 @@ int main() {
|
||||
break;
|
||||
}
|
||||
|
||||
printf("% 4d:%02d:%02d %02d:%02d:%02d %02d.%02d.%02d %d %d %02d %d %d %d %d %d %d %d\n",
|
||||
opTime.hour, opTime.minute, opTime.second,
|
||||
printf("%02d:%02d:%02d %02d.%02d.%02d %d %d %02d %d %d %d %d %d\n",
|
||||
clock.hour, clock.minute, clock.second,
|
||||
clock.day, clock.month, clock.year, clock.weekday,
|
||||
valid, state, bit, pulse, gap, validCnt, timeValidCnt,
|
||||
bufferReadIdx, bufferWriteIdx);
|
||||
valid, state, bit, pulse, gap, validCnt, timeValidCnt);
|
||||
|
||||
state++;
|
||||
} else {
|
||||
|
||||
printf("% 4d:%02d:%02d %02d:%02d:%02d %02d.%02d.%02d %d %d %02d %d %d %d %d %d %d %d\n",
|
||||
opTime.hour, opTime.minute, opTime.second,
|
||||
printf("%02d:%02d:%02d %02d.%02d.%02d %d %d %02d %d %d %d %d %d\n",
|
||||
clock.hour, clock.minute, clock.second,
|
||||
clock.day, clock.month, clock.year, clock.weekday,
|
||||
valid, state, bit, pulse, gap, validCnt, timeValidCnt,
|
||||
bufferReadIdx, bufferWriteIdx);
|
||||
valid, state, bit, pulse, gap, validCnt, timeValidCnt);
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
static uint8_t oldPositionSwitch = 255;
|
||||
uint8_t positionSwitch = PINB & ((1 << PB1) | (1 << PB2));
|
||||
if (oldPositionSwitch != positionSwitch) {
|
||||
oldPositionSwitch = positionSwitch;
|
||||
printf("POS: %02d\n", positionSwitch);
|
||||
if (clockNextMinute()) {
|
||||
opTime_t opTime = clockGetOpTime();
|
||||
printf("% 4d:%02d:%02d\n", opTime.hour, opTime.minute, opTime.second);
|
||||
}
|
||||
|
||||
if ((timeValidCnt > 0) && (step != 0)) {
|
||||
step = 0;
|
||||
|
||||
static uint8_t stepperState = 0;
|
||||
|
||||
static uint8_t currentMinutePosition = 0;
|
||||
static uint8_t minuteStepPosition = 0;
|
||||
static int8_t minuteDirection = 0;
|
||||
|
||||
static uint8_t currentHourPosition = 0;
|
||||
static uint8_t hourStepPosition = 0;
|
||||
static int8_t hourDirection = 0;
|
||||
|
||||
switch (stepperState) {
|
||||
case 0:
|
||||
//printf("0 ");
|
||||
// is current minute position different from desired one?
|
||||
minuteStepPosition = clock.minute * STEPS_PER_MINUTE;
|
||||
|
||||
if (currentMinutePosition != minuteStepPosition) {
|
||||
printf("M:\n");
|
||||
|
||||
stepperState = 1;
|
||||
}
|
||||
break;
|
||||
case 1:
|
||||
printf("1 ");
|
||||
// switch on the minute motor and set the direction
|
||||
PORTA |= (1 << PA1);
|
||||
|
||||
if (currentMinutePosition > minuteStepPosition) {
|
||||
printf("b\n");
|
||||
minuteDirection = -1;
|
||||
PORTC &= ~(1 << PC2);
|
||||
} else {
|
||||
printf("f\n");
|
||||
minuteDirection = 1;
|
||||
PORTC |= (1 << PC2);
|
||||
if (clockNextStep()) {
|
||||
stepperEngine();
|
||||
}
|
||||
|
||||
stepperState = 2;
|
||||
break;
|
||||
case 2:
|
||||
printf("2 ");
|
||||
|
||||
// move one step
|
||||
|
||||
printf("d: %d, c: %d\n", minuteStepPosition, currentMinutePosition);
|
||||
|
||||
currentMinutePosition += minuteDirection;
|
||||
|
||||
PORTC |= (1 << PC3);
|
||||
_delay_us(50);
|
||||
PORTC &= ~(1 << PC3);
|
||||
|
||||
if (currentMinutePosition == minuteStepPosition) {
|
||||
stepperState = 3;
|
||||
}
|
||||
break;
|
||||
case 3:
|
||||
printf("3\n");
|
||||
|
||||
// switch off the minute motor
|
||||
PORTA &= ~(1 << PA1);
|
||||
|
||||
stepperState = 4;
|
||||
break;
|
||||
case 4:
|
||||
printf("4 ");
|
||||
|
||||
// is current hour position different from desired one?
|
||||
hourStepPosition = clock.hour * STEPS_PER_HOUR;
|
||||
|
||||
if (currentHourPosition != hourStepPosition) {
|
||||
printf(" H:\n");
|
||||
|
||||
stepperState = 5;
|
||||
} else {
|
||||
// done
|
||||
printf("\n");
|
||||
stepperState = 0;
|
||||
}
|
||||
break;
|
||||
case 5:
|
||||
printf("5 ");
|
||||
|
||||
// switch on the hour motor and set the direction
|
||||
PORTA |= (1 << PA0);
|
||||
|
||||
if (currentHourPosition > hourStepPosition) {
|
||||
printf("b\n");
|
||||
hourDirection = -1;
|
||||
PORTC |= (1 << PC0);
|
||||
} else {
|
||||
printf("f\n");
|
||||
hourDirection = 1;
|
||||
PORTC &= ~(1 << PC0);
|
||||
}
|
||||
|
||||
stepperState = 6;
|
||||
break;
|
||||
case 6:
|
||||
printf("6 ");
|
||||
|
||||
// move one step
|
||||
|
||||
printf("d: %d, c: %d\n", hourStepPosition, currentHourPosition);
|
||||
|
||||
currentHourPosition += hourDirection;
|
||||
|
||||
PORTC |= (1 << PC1);
|
||||
_delay_us(50);
|
||||
PORTC &= ~(1 << PC1);
|
||||
|
||||
if (currentHourPosition == hourStepPosition) {
|
||||
stepperState = 7;
|
||||
}
|
||||
break;
|
||||
case 7:
|
||||
printf("7\n");
|
||||
|
||||
// switch off the hour motor
|
||||
PORTA &= ~(1 << PA0);
|
||||
|
||||
stepperState = 8;
|
||||
break;
|
||||
case 8:
|
||||
printf("8\n");
|
||||
|
||||
// done
|
||||
stepperState = 0;
|
||||
break;
|
||||
default:
|
||||
printf("default\n");
|
||||
stepperState = 0;
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
if (tack != 0) {
|
||||
tack = 0;
|
||||
|
||||
uint8_t light = PIND & (1 << PD7);
|
||||
switch (valid) {
|
||||
case 0:
|
||||
PORTB &= ~(1 << PB0);
|
||||
break;
|
||||
case 1:
|
||||
if (ledToggle != 0) {
|
||||
ledToggle = 0;
|
||||
PORTB &= ~(1 << PB0);
|
||||
} else {
|
||||
ledToggle = 1;
|
||||
if (light != 0) {
|
||||
PORTB |= (1 << PB0);
|
||||
} else {
|
||||
PORTB &= ~(1 << PB0);
|
||||
}
|
||||
}
|
||||
break;
|
||||
case 2:
|
||||
if (light != 0) {
|
||||
PORTB |= (1 << PB0);
|
||||
} else {
|
||||
PORTB &= ~(1 << PB0);
|
||||
}
|
||||
break;
|
||||
}
|
||||
if (clockNextTack()) {
|
||||
validLedEngine(valid);
|
||||
}
|
||||
|
||||
}
|
||||
|
32
src/main.h
Normal file
32
src/main.h
Normal file
@ -0,0 +1,32 @@
|
||||
#ifndef MAIN_H_
|
||||
#define MAIN_H_
|
||||
|
||||
#include <stdint.h>
|
||||
|
||||
#define START_GAP_MIN 1500
|
||||
#define ONE_WIDTH_MIN 170
|
||||
#define ONE_WIDTH_MAX 260
|
||||
#define ZERO_WIDTH_MIN 70
|
||||
#define ZERO_WIDTH_MAX 150
|
||||
|
||||
typedef struct receivedData_s {
|
||||
uint8_t minuteDigit0;
|
||||
uint8_t minuteDigit1;
|
||||
uint8_t minuteOneCnt;
|
||||
uint8_t hourDigit0;
|
||||
uint8_t hourDigit1;
|
||||
uint8_t hourOneCnt;
|
||||
uint8_t dayDigit0;
|
||||
uint8_t dayDigit1;
|
||||
uint8_t weekdayDigit0;
|
||||
uint8_t monthDigit0;
|
||||
uint8_t monthDigit1;
|
||||
uint8_t yearDigit0;
|
||||
uint8_t yearDigit1;
|
||||
uint8_t dateOneCnt;
|
||||
} receivedData_t;
|
||||
|
||||
|
||||
|
||||
|
||||
#endif /* MAIN_H_ */
|
267
src/stepper.c
Normal file
267
src/stepper.c
Normal file
@ -0,0 +1,267 @@
|
||||
#include <stdint.h>
|
||||
#include <avr/io.h>
|
||||
#include <stdio.h>
|
||||
#include <util/delay.h>
|
||||
|
||||
|
||||
#include "main.h"
|
||||
#include "clock.h"
|
||||
#include "stepper.h"
|
||||
|
||||
#define STEPPER_REG_1_DIR DDRC
|
||||
#define STEPPER_REG_1 PORTC
|
||||
|
||||
#define HOUR_MOTOR_DIRECTION PC0
|
||||
#define HOUR_MOTOR_PULSE PC1
|
||||
#define MINUTE_MOTOR_DIRECTION PC2
|
||||
#define MINUTE_MOTOR_PULSE PC3
|
||||
|
||||
#define STEPPER_CTRL_RESET PC4
|
||||
|
||||
#define STEPPER_REG_2_DIR DDRA
|
||||
#define STEPPER_REG_2 PORTA
|
||||
|
||||
#define HOUR_MOTOR_ENABLE PA0
|
||||
#define MINUTE_MOTOR_ENABLE PA1
|
||||
|
||||
#define STEPPER_REG_3_DIR DDRB
|
||||
#define STEPPER_REG_3 PORTB
|
||||
|
||||
#define HOUR_POSITION_SWITCH PB1
|
||||
#define MINUTE_POSITION_SWITCH PB2
|
||||
|
||||
|
||||
uint8_t stepperEnableFlag = 0;
|
||||
|
||||
|
||||
static inline void hourMotorEnable() {
|
||||
STEPPER_REG_2 |= (1 << HOUR_MOTOR_ENABLE);
|
||||
}
|
||||
|
||||
static inline void hourMotorDisable() {
|
||||
STEPPER_REG_2 &= ~(1 << HOUR_MOTOR_ENABLE);
|
||||
}
|
||||
|
||||
static inline void minuteMotorEnable() {
|
||||
STEPPER_REG_2 |= (1 << MINUTE_MOTOR_ENABLE);
|
||||
}
|
||||
|
||||
static inline void minuteMotorDisable() {
|
||||
STEPPER_REG_2 &= ~(1 << MINUTE_MOTOR_ENABLE);
|
||||
}
|
||||
|
||||
|
||||
static inline void hourMotorForward() {
|
||||
STEPPER_REG_1 &= ~(1 << HOUR_MOTOR_DIRECTION);
|
||||
}
|
||||
|
||||
static inline void hourMotorBackward() {
|
||||
STEPPER_REG_1 |= (1 << HOUR_MOTOR_DIRECTION);
|
||||
}
|
||||
|
||||
static inline void minuteMotorForward() {
|
||||
STEPPER_REG_1 &= ~(1 << MINUTE_MOTOR_DIRECTION);
|
||||
}
|
||||
|
||||
static inline void minuteMotorBackward() {
|
||||
STEPPER_REG_1 |= (1 << MINUTE_MOTOR_DIRECTION);
|
||||
}
|
||||
|
||||
|
||||
static inline void hourMotorPulse() {
|
||||
STEPPER_REG_1 |= (1 << HOUR_MOTOR_PULSE);
|
||||
_delay_us(50);
|
||||
STEPPER_REG_1 &= ~(1 << HOUR_MOTOR_PULSE);
|
||||
}
|
||||
|
||||
static inline void minuteMotorPulse() {
|
||||
STEPPER_REG_1 |= (1 << MINUTE_MOTOR_PULSE);
|
||||
_delay_us(50);
|
||||
STEPPER_REG_1 &= ~(1 << MINUTE_MOTOR_PULSE);
|
||||
}
|
||||
|
||||
|
||||
static inline void stepperCtrlReset() {
|
||||
STEPPER_REG_1 &= ~(1 << STEPPER_CTRL_RESET);
|
||||
_delay_ms(1);
|
||||
STEPPER_REG_1 |= (1 << STEPPER_CTRL_RESET);
|
||||
}
|
||||
|
||||
void stepperInit() {
|
||||
// stepper
|
||||
STEPPER_REG_1_DIR |= (1 << STEPPER_CTRL_RESET) |
|
||||
(1 << MINUTE_MOTOR_PULSE) | (1 << MINUTE_MOTOR_DIRECTION) |
|
||||
(1 << HOUR_MOTOR_PULSE) | (1 << HOUR_MOTOR_DIRECTION);
|
||||
STEPPER_REG_2_DIR |= (1 << MINUTE_MOTOR_ENABLE) | (1 << HOUR_MOTOR_ENABLE);
|
||||
|
||||
STEPPER_REG_1 &= ~(1 << MINUTE_MOTOR_PULSE);
|
||||
STEPPER_REG_1 &= ~(1 << MINUTE_MOTOR_DIRECTION);
|
||||
STEPPER_REG_1 &= ~(1 << HOUR_MOTOR_PULSE);
|
||||
STEPPER_REG_1 &= ~(1 << HOUR_MOTOR_DIRECTION);
|
||||
|
||||
STEPPER_REG_2 &= ~(1 << MINUTE_MOTOR_ENABLE);
|
||||
STEPPER_REG_2 &= ~(1 << HOUR_MOTOR_ENABLE);
|
||||
|
||||
// position switches
|
||||
STEPPER_REG_3_DIR &= ~(1 << MINUTE_POSITION_SWITCH);
|
||||
STEPPER_REG_3_DIR &= ~(1 << HOUR_POSITION_SWITCH);
|
||||
|
||||
// pull-up on
|
||||
STEPPER_REG_3 |= (1 << MINUTE_POSITION_SWITCH) | (1 << HOUR_POSITION_SWITCH);
|
||||
|
||||
|
||||
stepperCtrlReset();
|
||||
}
|
||||
|
||||
|
||||
//static uint8_t oldPositionSwitch = 255;
|
||||
//uint8_t positionSwitch = PINB & ((1 << PB1) | (1 << PB2));
|
||||
//if (oldPositionSwitch != positionSwitch) {
|
||||
// oldPositionSwitch = positionSwitch;
|
||||
// printf("POS: %02d\n", positionSwitch);
|
||||
//}
|
||||
|
||||
|
||||
void stepperEnable() {
|
||||
stepperEnableFlag = 1;
|
||||
|
||||
}
|
||||
void stepperEngine() {
|
||||
|
||||
static uint8_t stepperState = 0;
|
||||
|
||||
static uint8_t currentMinutePosition = 0;
|
||||
static uint8_t minuteStepPosition = 0;
|
||||
static int8_t minuteDirection = 0;
|
||||
|
||||
static uint8_t currentHourPosition = 0;
|
||||
static uint8_t hourStepPosition = 0;
|
||||
static int8_t hourDirection = 0;
|
||||
|
||||
clock_t clock = clockGetClock();
|
||||
|
||||
switch (stepperState) {
|
||||
case 0:
|
||||
//printf("0 ");
|
||||
if (stepperEnableFlag == 1) {
|
||||
// is current minute position different from desired one?
|
||||
minuteStepPosition = clock.minute * STEPS_PER_MINUTE;
|
||||
|
||||
if (currentMinutePosition != minuteStepPosition) {
|
||||
printf("M:\n");
|
||||
|
||||
stepperState = 1;
|
||||
}
|
||||
}
|
||||
break;
|
||||
case 1:
|
||||
printf("1 ");
|
||||
// switch on the minute motor and set the direction
|
||||
minuteMotorEnable();
|
||||
|
||||
if (currentMinutePosition > minuteStepPosition) {
|
||||
printf("b\n");
|
||||
minuteDirection = -1;
|
||||
minuteMotorBackward();
|
||||
} else {
|
||||
printf("f\n");
|
||||
minuteDirection = 1;
|
||||
minuteMotorForward();
|
||||
}
|
||||
|
||||
stepperState = 2;
|
||||
break;
|
||||
case 2:
|
||||
printf("2 ");
|
||||
|
||||
// move one step
|
||||
|
||||
printf("d: %d, c: %d\n", minuteStepPosition, currentMinutePosition);
|
||||
|
||||
currentMinutePosition += minuteDirection;
|
||||
|
||||
minuteMotorPulse();
|
||||
|
||||
if (currentMinutePosition == minuteStepPosition) {
|
||||
stepperState = 3;
|
||||
}
|
||||
break;
|
||||
case 3:
|
||||
printf("3\n");
|
||||
|
||||
// switch off the minute motor
|
||||
minuteMotorDisable();
|
||||
|
||||
stepperState = 4;
|
||||
break;
|
||||
case 4:
|
||||
printf("4 ");
|
||||
|
||||
// is current hour position different from desired one?
|
||||
hourStepPosition = clock.hour * STEPS_PER_HOUR;
|
||||
|
||||
if (currentHourPosition != hourStepPosition) {
|
||||
printf(" H:\n");
|
||||
|
||||
stepperState = 5;
|
||||
} else {
|
||||
// done
|
||||
printf("\n");
|
||||
stepperState = 0;
|
||||
}
|
||||
break;
|
||||
case 5:
|
||||
printf("5 ");
|
||||
|
||||
// switch on the hour motor and set the direction
|
||||
hourMotorEnable();
|
||||
|
||||
if (currentHourPosition > hourStepPosition) {
|
||||
printf("b\n");
|
||||
hourDirection = -1;
|
||||
hourMotorBackward();
|
||||
} else {
|
||||
printf("f\n");
|
||||
hourDirection = 1;
|
||||
hourMotorForward();
|
||||
}
|
||||
|
||||
stepperState = 6;
|
||||
break;
|
||||
case 6:
|
||||
printf("6 ");
|
||||
|
||||
// move one step
|
||||
|
||||
printf("d: %d, c: %d\n", hourStepPosition, currentHourPosition);
|
||||
|
||||
currentHourPosition += hourDirection;
|
||||
|
||||
hourMotorPulse();
|
||||
|
||||
if (currentHourPosition == hourStepPosition) {
|
||||
stepperState = 7;
|
||||
}
|
||||
break;
|
||||
case 7:
|
||||
printf("7\n");
|
||||
|
||||
// switch off the hour motor
|
||||
hourMotorDisable();
|
||||
|
||||
stepperState = 8;
|
||||
break;
|
||||
case 8:
|
||||
printf("8\n");
|
||||
|
||||
// done
|
||||
stepperState = 0;
|
||||
break;
|
||||
default:
|
||||
printf("default\n");
|
||||
stepperState = 0;
|
||||
break;
|
||||
}
|
||||
|
||||
}
|
||||
|
18
src/stepper.h
Normal file
18
src/stepper.h
Normal file
@ -0,0 +1,18 @@
|
||||
#ifndef STEPPER_H_
|
||||
#define STEPPER_H_
|
||||
|
||||
#include <stdint.h>
|
||||
#include "main.h"
|
||||
#include "clock.h"
|
||||
|
||||
#define STEPS_PER_MINUTE 3
|
||||
#define STEPS_PER_HOUR 7
|
||||
|
||||
|
||||
|
||||
void stepperInit();
|
||||
void stepperEnable();
|
||||
void stepperEngine();
|
||||
|
||||
|
||||
#endif /* STEPPER_H_ */
|
@ -6,21 +6,28 @@
|
||||
|
||||
|
||||
|
||||
#define BUFFER_SIZE 256
|
||||
volatile uint8_t buffer[BUFFER_SIZE+5];
|
||||
volatile uint8_t buffer[UART_TX_BUFFER_SIZE+5];
|
||||
volatile uint8_t bufferReadIdx = 0;
|
||||
volatile uint8_t bufferWriteIdx = 0;
|
||||
|
||||
void uartdrvInit() {
|
||||
static inline void enableDataRegisterEmptyInterrupt() {
|
||||
UCSRB |= (1 << UDRIE);
|
||||
}
|
||||
|
||||
// UART
|
||||
static inline void disableDataRegisterEmptyInterrupt() {
|
||||
UCSRB &= ~(1 << UDRIE);
|
||||
}
|
||||
|
||||
void uartdrvInit() {
|
||||
// TXD
|
||||
DDRD |= (1 << PD1);
|
||||
|
||||
// transmitter enable
|
||||
UCSRB = (1 << TXEN);
|
||||
|
||||
// 8 data bit, no parity, 1 stop bit
|
||||
UCSRC = (1 << UCSZ1) | (1 << UCSZ0);
|
||||
|
||||
// 2400 Baud @ 16MHz
|
||||
UBRRL = 0xa0;
|
||||
UBRRH = 0x01;;
|
||||
@ -30,16 +37,16 @@ void uartdrvInit() {
|
||||
}
|
||||
|
||||
void uartdrvWrite(uint8_t o) {
|
||||
// loop_until_bit_is_set(UCSRA, UDRE);
|
||||
// UDR = o;
|
||||
if (bufferWriteIdx == BUFFER_SIZE - 1) {
|
||||
while (bufferReadIdx == BUFFER_SIZE);
|
||||
if (bufferWriteIdx == UART_TX_BUFFER_SIZE - 1) {
|
||||
while (bufferReadIdx == UART_TX_BUFFER_SIZE);
|
||||
} else {
|
||||
while (bufferReadIdx == bufferWriteIdx + 1);
|
||||
}
|
||||
|
||||
buffer[bufferWriteIdx] = o;
|
||||
bufferWriteIdx++;
|
||||
UCSRB |= (1 << UDRIE);
|
||||
|
||||
enableDataRegisterEmptyInterrupt();
|
||||
}
|
||||
|
||||
|
||||
@ -55,10 +62,10 @@ ISR(USART_UDRE_vect) {
|
||||
if (bufferReadIdx != bufferWriteIdx) {
|
||||
UDR = buffer[bufferReadIdx];
|
||||
bufferReadIdx++;
|
||||
if (bufferReadIdx > BUFFER_SIZE) {
|
||||
if (bufferReadIdx > UART_TX_BUFFER_SIZE) {
|
||||
bufferReadIdx = 0;
|
||||
}
|
||||
} else {
|
||||
UCSRB &= ~(1 << UDRIE);
|
||||
disableDataRegisterEmptyInterrupt();
|
||||
}
|
||||
}
|
||||
|
@ -5,28 +5,12 @@
|
||||
#include <stdio.h>
|
||||
|
||||
|
||||
#define UART_CMD_BUF_SIZE 4
|
||||
#define UART_CMD_CYCLES 10
|
||||
|
||||
typedef struct uartdrvCmdBuf_s {
|
||||
uint8_t idx;
|
||||
uint8_t cmdStart;
|
||||
uint8_t cmdDelay;
|
||||
uint8_t cmdReady;
|
||||
uint8_t cmd;
|
||||
uint8_t buf[UART_CMD_BUF_SIZE];
|
||||
} uartdrvCmdBuf_t;
|
||||
#define UART_TX_BUFFER_SIZE 256
|
||||
|
||||
|
||||
extern void uartInitCallback();
|
||||
extern void uartWriteCallback(uint8_t o);
|
||||
|
||||
int uartdrvPutchar(char c, FILE *stream);
|
||||
void uartdrvInit();
|
||||
void uartdrvWrite(uint8_t o);
|
||||
|
||||
void uartdrvCmdCycle();
|
||||
|
||||
void uartdrvCmdReceived();
|
||||
|
||||
#endif /* UARTDRV_H_ */
|
||||
|
75
src/validLed.c
Normal file
75
src/validLed.c
Normal file
@ -0,0 +1,75 @@
|
||||
#include <stdint.h>
|
||||
#include <avr/io.h>
|
||||
|
||||
#include "main.h"
|
||||
|
||||
|
||||
#define VALID_LED_REG_DIR DDRB
|
||||
#define VALID_LED_REG PORTB
|
||||
|
||||
#define VALID_LED PB0
|
||||
|
||||
#define DARK_SWITCH_REG_DIR DDRD
|
||||
#define DARK_SWITCH_OUT_REG PORTD
|
||||
#define DARK_SWITCH_IN_REG PIND
|
||||
|
||||
#define DARK_SWITCH PD7
|
||||
|
||||
|
||||
|
||||
uint8_t isNotDark() {
|
||||
return DARK_SWITCH_IN_REG & (1 << DARK_SWITCH);
|
||||
}
|
||||
|
||||
static inline void validLedEnable() {
|
||||
PORTB |= (1 << PB0);
|
||||
}
|
||||
|
||||
static inline void validLedDisable() {
|
||||
PORTB &= ~(1 << PB0);
|
||||
}
|
||||
|
||||
|
||||
void validLedInit() {
|
||||
// validLed
|
||||
VALID_LED_REG_DIR |= (1 << VALID_LED);
|
||||
|
||||
// dark switch
|
||||
DARK_SWITCH_REG_DIR &= ~(1 << DARK_SWITCH);
|
||||
// pull-up on
|
||||
DARK_SWITCH_OUT_REG |= (1 << DARK_SWITCH);
|
||||
}
|
||||
|
||||
|
||||
void validLedEngine(uint8_t valid) {
|
||||
static uint8_t ledToggle = 0;
|
||||
|
||||
uint8_t light = isNotDark();
|
||||
|
||||
switch (valid) {
|
||||
case 0:
|
||||
validLedDisable();
|
||||
break;
|
||||
case 1:
|
||||
if (ledToggle != 0) {
|
||||
ledToggle = 0;
|
||||
validLedDisable();
|
||||
} else {
|
||||
ledToggle = 1;
|
||||
if (light != 0) {
|
||||
validLedEnable();
|
||||
} else {
|
||||
validLedDisable();
|
||||
}
|
||||
}
|
||||
break;
|
||||
case 2:
|
||||
if (light != 0) {
|
||||
validLedEnable();
|
||||
} else {
|
||||
validLedDisable();
|
||||
}
|
||||
break;
|
||||
}
|
||||
|
||||
}
|
10
src/validLed.h
Normal file
10
src/validLed.h
Normal file
@ -0,0 +1,10 @@
|
||||
#ifndef VALIDLED_H_
|
||||
#define VALIDLED_H_
|
||||
|
||||
|
||||
|
||||
void validLedInit();
|
||||
void validLedEngine(uint8_t valid);
|
||||
|
||||
|
||||
#endif /* VALIDLED_H_ */
|
Reference in New Issue
Block a user