121 lines
2.2 KiB
C++
121 lines
2.2 KiB
C++
/*
|
|
* ioController.cpp
|
|
*
|
|
* Created on: 20.11.2018
|
|
* Author: Hendrik Schutter
|
|
*/
|
|
|
|
#include "openChargeMicro.h"
|
|
|
|
ioController::ioController() {
|
|
ports_init();
|
|
adc_init();
|
|
}
|
|
|
|
ioController::~ioController() {
|
|
|
|
}
|
|
|
|
double ioController::get5VProbe() {
|
|
int tmp = (int) readAdc(2);
|
|
double ret = ((double) tmp) * 0.006242;
|
|
return ret;
|
|
}
|
|
|
|
double ioController::get15VProbe() {
|
|
int tmp = (int) readAdc(1);
|
|
double ret = ((double) tmp) * 0.014968;
|
|
return ret;
|
|
}
|
|
|
|
void ioController::ports_init() {
|
|
DDRB |= 1 << ACTIVELED;
|
|
DDRB |= 1 << BUZZER;
|
|
DDRB |= 1 << POWERON;
|
|
DDRD |= 1 << S2;
|
|
DDRD |= 1 << S1;
|
|
DDRD |= 1 << S0;
|
|
|
|
DDRC &= ~(1 << PROBE15V);
|
|
DDRC &= ~(1 << PROBE5V);
|
|
DDRC &= ~(1 << Z);
|
|
}
|
|
|
|
void ioController::activateChargers() {
|
|
|
|
PORTB &= ~(1 << POWERON); //OFF
|
|
}
|
|
|
|
void ioController::deactivateChargers() {
|
|
PORTB |= (1 << POWERON); //ON
|
|
}
|
|
|
|
void ioController::setActiveLED(bool pBool) {
|
|
if (pBool) {
|
|
PORTB |= (1 << ACTIVELED); //ON
|
|
} else {
|
|
PORTB &= ~(1 << ACTIVELED); //OFF
|
|
}
|
|
}
|
|
|
|
void ioController::setBuzzer(bool pBool) {
|
|
//TODO needs testing
|
|
if (!pBool) {
|
|
PORTB |= (1 << BUZZER); //ON
|
|
} else {
|
|
PORTB &= ~(1 << BUZZER); //OFF
|
|
}
|
|
}
|
|
|
|
void ioController::adc_init(void) {
|
|
ADMUX = (1 << REFS0); //select AVCC as reference
|
|
ADCSRA = (1 << ADEN) | 7; //enable and prescale = 128 (16MHz/128 = 125kHz)
|
|
}
|
|
|
|
int ioController::readAdc(char ch) {
|
|
ADMUX = (1 << REFS0) | (ch & 0x0f); //select input and ref
|
|
ADCSRA |= (1 << ADSC); //start the conversion
|
|
while (ADCSRA & (1 << ADSC))
|
|
; //wait for end of conversion
|
|
return ADCW;
|
|
}
|
|
|
|
void ioController::setMultiplexer(bool pS2, bool pS1, bool pS0) {
|
|
|
|
if (pS0) {
|
|
PORTD |= (1 << S0); //ON
|
|
} else {
|
|
PORTD &= ~(1 << S0); //OFF
|
|
}
|
|
|
|
if (pS1) {
|
|
PORTD |= (1 << S1); //ON
|
|
} else {
|
|
PORTD &= ~(1 << S1); //OFF
|
|
}
|
|
|
|
if (pS2) {
|
|
PORTD |= (1 << S2); //ON
|
|
} else {
|
|
PORTD &= ~(1 << S2); //OFF
|
|
}
|
|
|
|
}
|
|
|
|
void ioController::setWS2812(const unsigned char red, const unsigned char green,
|
|
const unsigned char blue) {
|
|
|
|
WS2812 led(LED_C);
|
|
led.set_output(&PORTD, &DDRD, DDD2);
|
|
Color strobe;
|
|
uint8_t i;
|
|
|
|
strobe.r = red;
|
|
strobe.g = green;
|
|
strobe.b = blue;
|
|
for (i = 0; i < LED_C; i++)
|
|
led.set_rgb_at(i, strobe);
|
|
led.sync();
|
|
}
|
|
|