RadioButtons.cpp

#include "RadioButtons.h"

//#define DEBUG

#ifdef DEBUG
#include <iostream>
#endif

void RadioButtons::init(unsigned char * buttonIndexes, unsigned char count) {
	buttonIndexes_ = buttonIndexes;
	buttonCount_ = count;
	selectedButton_ = 0;
	lastDownButton_ = 255;
	for (unsigned char i = 0; i < buttonCount_; i++) {
		if (LEDsAndButtonsHWWrapper::isButtonDown(buttonIndexes_[i])) {
			lastDownButton_ = i;
		}
	}
	buttonSelected_ = false;
}

void RadioButtons::update() {
    for (unsigned char i = 0; i < buttonCount_; i++) {
        bool buttonDown = LEDsAndButtonsHWWrapper::isButtonDown(buttonIndexes_[i]);
#ifdef DEBUG
        printf("Button: %i %s Last button down: %i\n", buttonIndexes_[i], buttonDown ? "DOWN" : "UP", lastDownButton_);
#endif
        if (buttonDown) {
            //Button that is down is the same as previous one so just ignore everything
            if (lastDownButton_ == i) {
                return;
            }
            if (!buttonSelected_ || selectedButton_ != i) {
            	setSelectedButton(i);
            } else {
            	resetSelection();
            }
            lastDownButton_ = i;
            return;
        }
        //Disable lastButtonDown by value that hopefully will never occur
    }
    lastDownButton_ = 255;
}

void RadioButtons::setSelectedButton(unsigned char selectedButton) {
	resetSelection();
	selectedButton_ = selectedButton;
	buttonSelected_ = true;
}


bool RadioButtons::getSelectedButton(unsigned char &selectedButton)
{
    if (buttonSelected_) {
        selectedButton = selectedButton_;
        return true;
    }
    return false;
}