1 files changed, 51 insertions, 0 deletions
diff --git a/tk-delay.h b/tk-delay.h
new file mode 100644
index 0000000..572d75e
--- /dev/null
+++ b/tk-delay.h
@@ -0,0 +1,51 @@
+#ifndef TK_DELAY_H
+#define TK_DELAY_H
+/*
+ * Smaller, more flexible replacement(s) for default _delay_ms() functions.
+ *
+ * Copyright (C) 2015 Selene ToyKeeper
+ *
+ * This program is free software: you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License as published by
+ * the Free Software Foundation, either version 3 of the License, or
+ * (at your option) any later version.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ * GNU General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program.  If not, see <http://www.gnu.org/licenses/>.
+ *
+ */
+
+#ifdef OWN_DELAY
+#include "tk-attiny.h"
+#include <util/delay_basic.h>
+// Having own _delay_ms() saves some bytes AND adds possibility to use variables as input
+void _delay_ms(uint16_t n)
+{
+    // TODO: make this take tenths of a ms instead of ms,
+    // for more precise timing?
+    #ifdef USE_FINE_DELAY
+    if (n==0) { _delay_loop_2(BOGOMIPS/3); }
+    else {
+        while(n-- > 0) _delay_loop_2(BOGOMIPS);
+    }
+    #else
+    while(n-- > 0) _delay_loop_2(BOGOMIPS);
+    #endif
+}
+#ifdef USE_DELAY_S
+void _delay_s()  // because it saves a bit of ROM space to do it this way
+{
+    _delay_ms(BOGOMIPS);
+}
+#endif
+#else
+#include <util/delay.h>
+#endif
+
+
+#endif  // TK_DELAY_H