Created more helpers

firmware/src/dccd/handbrake.cpp

@@ -0,0 +1,70 @@
+/**** Includes ****/
+#include "../utils/utils.h"
+#include "handbrake.h"
+
+using namespace dccd;
+
+/**** Private definitions ****/
+/**** Private constants ****/
+/**** Private variables ****/
+/**** Private function declarations ****/
+/**** Public function definitions ****/
+dccd::Handbrake::Handbrake(void)
+{
+	return;
+}
+
+dccd::Handbrake::~Handbrake(void)
+{
+	return;
+}
+
+void dccd::Handbrake::init(dccd::DccdHw* dccd_hw)
+{	
+	this->hardware = dccd_hw;
+	this->latch_time = 0;
+	this->hbrake_latch = 0;
+	this->start_ts = 0;
+	this->is_active = 0;
+}
+
+void dccd::Handbrake::cfg_debounce(uint16_t dbnc_time)
+{
+	this->hardware->handbrake.dbnc_lim = dbnc_time;
+}
+
+uint8_t dccd::Handbrake::process(void)
+{
+	uint16_t ts_now = this->hardware->counter.read();
+	
+	if(this->hardware->handbrake.state > 0)
+	{
+		if(this->hardware->handbrake.is_new)
+		{
+			this->hardware->handbrake.is_new = 0;
+			// Note start time
+			this->start_ts = ts_now;
+			this->hbrake_latch = 1;
+		};
+		this->is_active = 1;
+	}
+	else if((this->hbrake_latch != 0)&&(this->latch_time != 0))
+	{
+		uint16_t td = util::time_delta(this->start_ts, ts_now);
+		uint32_t td_ms = this->hardware->counter.convert_ms(td);
+		if(td_ms >= this->latch_time)
+		{
+			this->hbrake_latch = 0;
+			if(this->hardware->handbrake.state > 0) this->is_active = 1;
+			else this->is_active = 0;
+		};
+	}
+	else
+	{
+		this->is_active = 0;
+	}
+	
+	return this->is_active;
+}
+
+/**** Private function definitions ***/