123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172 |
-
- #include <avr/io.h>
- #include <stdint.h>
- #include <stdlib.h>
- #include <util/delay.h>
-
- #include "eq.h"
- #include "adc.h"
-
- #define RESETDELAY 1
- #define RESETSTROBEDELAY 72
- #define STROBEDELAY 18
- #define READDELAY 36
-
- #if ((STROBEDELAY * 2) + READDELAY) < 72
- #error Strobe to Strobe Delay too short
- #endif
-
- void equalizerInit(void) {
- DDRC |= 12;
-
-
- PORTC |= (1 << PC3);
- _delay_us(RESETDELAY);
-
- }
-
- uint8_t *equalizerGet(void) {
- uint8_t *result = (uint8_t *)malloc(7);
- uint8_t i, offset = getOffset();
-
- PORTC &= ~(1 << PC3);
- _delay_us(RESETSTROBEDELAY);
-
- for (i = 0; i < 7; i++) {
- PORTC |= (1 << PC2);
- _delay_us(STROBEDELAY);
- PORTC &= ~(1 << PC2);
- adcStartConversion(0x00);
- _delay_us(READDELAY);
- result[i] = offset + adcGetByte();
- _delay_us(STROBEDELAY);
- }
-
- return result;
- }
-
- uint8_t getOffset(void) {
- adcStartConversion(0x01);
- return (adcGetByte() / 2);
- }
|