Add millis timer for timekeeping

fantemp/clock.cpp

@@ -0,0 +1,37 @@
+#include "clock.hpp"
+
+#include <avr/interrupt.h>
+#include <avr/io.h>
+
+namespace clk {
+
+namespace detail {
+
+volatile uint64_t sm_millisCounter = 0;
+
+ISR(TIMER2_COMPA_vect)
+{
+	++sm_millisCounter;
+}
+
+} // namespace detail
+
+void init()
+{
+	TCCR2A |= (1 << WGM21);
+	TCCR2B |= (1 << CS22) | (1 << CS20);
+	OCR2A = 124;
+	TIMSK2 |= (1 << OCIE2A);
+}
+
+uint64_t millis()
+{
+	const auto oldSreg = SREG;
+	cli();
+	const auto millisCounter = detail::sm_millisCounter;
+	SREG = oldSreg;
+
+	return millisCounter;
+}
+
+} // namespace clk

fantemp/clock.hpp

@@ -2,3 +2,12 @@
 
 #define F_CPU 16000000
 #include <util/delay.h>
+
+#include <stdint.h>
+
+namespace clk {
+
+void init();
+uint64_t millis();
+
+} // namespace clk

fantemp/fantemp.cppproj

@@ -68,6 +68,19 @@
       <ToolNumber>J41800099437</ToolNumber>
       <ToolName>Atmel-ICE</ToolName>
     </com_atmel_avrdbg_tool_atmelice>
+    <custom>
+      <ToolOptions>
+        <InterfaceProperties>
+          <IspClock>125000</IspClock>
+        </InterfaceProperties>
+        <InterfaceName>
+        </InterfaceName>
+      </ToolOptions>
+      <ToolType>custom</ToolType>
+      <ToolNumber>
+      </ToolNumber>
+      <ToolName>Custom Programming Tool</ToolName>
+    </custom>
   </PropertyGroup>
   <PropertyGroup Condition=" '$(Configuration)' == 'Release' ">
     <ToolchainSettings>
@@ -206,6 +219,9 @@
     <Compile Include="bootloader.hpp">
       <SubType>compile</SubType>
     </Compile>
+    <Compile Include="clock.cpp">
+      <SubType>compile</SubType>
+    </Compile>
     <Compile Include="clock.hpp">
       <SubType>compile</SubType>
     </Compile>

fantemp/main.cpp

@@ -20,6 +20,8 @@ int main()
 	Controller controller;
 	controller.init();
 
+	clk::init();
+
 	while (true) {
 		controller.callback();
 		terminal.callback();

fantemp/terminal.hpp

@@ -8,6 +8,7 @@
 
 #include "flash/flash.hpp"
 
+#include "clock.hpp"
 #include "controller.hpp"
 
 namespace detail {
@@ -97,9 +98,9 @@ class Terminal {
 			parseInput();
 		}
 
-		if (m_state == State::MONITOR && --m_monitorDelayCounter == 0) {
+		if (m_state == State::MONITOR && clk::millis() >= m_monitorDelayLastUpdate + MONITOR_DELAY) {
 			showState();
-			m_monitorDelayCounter = MONITOR_DELAY;
+			m_monitorDelayLastUpdate = clk::millis();
 		}
 	}
 
@@ -107,7 +108,7 @@ class Terminal {
 	static constexpr auto INPUT_BUFFER_SIZE = 128;
 	static constexpr auto BACKSPACE = uint8_t{0x7f};
 	static constexpr auto CTRL_C = uint8_t{0x03};
-	static constexpr auto MONITOR_DELAY = 60000;
+	static constexpr auto MONITOR_DELAY = 500;
 
 	enum class State {
 		NONE,
@@ -118,7 +119,7 @@ class Terminal {
 	static char m_inputBuffer[INPUT_BUFFER_SIZE];
 	static uint16_t m_inputSize;
 	static State m_state;
-	static uint16_t m_monitorDelayCounter;
+	static uint64_t m_monitorDelayLastUpdate;
 
 	static void parseInput()
 	{
@@ -134,7 +135,6 @@ class Terminal {
 					printCurve();
 				} else if (substringEquals(m_inputBuffer, detail::MONITOR_CMD, m_inputSize)) {
 					m_state = State::MONITOR;
-					m_monitorDelayCounter = MONITOR_DELAY;
 				} else if (substringEquals(m_inputBuffer, detail::BOOTLOADER_CMD, m_inputSize)) {
 					handleBootloader();
 				} else if (substringEquals(m_inputBuffer, detail::VERSION_CMD, m_inputSize)) {
@@ -227,4 +227,4 @@ template <class Uart>
 typename Terminal<Uart>::State Terminal<Uart>::m_state = State::NONE;
 
 template <class Uart>
-uint16_t Terminal<Uart>::m_monitorDelayCounter;
+uint64_t Terminal<Uart>::m_monitorDelayLastUpdate = 0;