You can not select more than 25 topics Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.

51 lines
1.4KB

  1. // Copyright 2009 Olivier Gillet.
  2. //
  3. // Author: Olivier Gillet (ol.gillet@gmail.com)
  4. //
  5. // This program is free software: you can redistribute it and/or modify
  6. // it under the terms of the GNU General Public License as published by
  7. // the Free Software Foundation, either version 3 of the License, or
  8. // (at your option) any later version.
  9. // This program is distributed in the hope that it will be useful,
  10. // but WITHOUT ANY WARRANTY; without even the implied warranty of
  11. // MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  12. // GNU General Public License for more details.
  13. // You should have received a copy of the GNU General Public License
  14. // along with this program. If not, see <http://www.gnu.org/licenses/>.
  15. //
  16. // -----------------------------------------------------------------------------
  17. //
  18. // Real time clock. Based on the code in the arduino core library
  19. // by David A. Mellis.
  20. #include "avrlib/time.h"
  21. #include "avrlib/timer.h"
  22. namespace avrlib {
  23. volatile LongWord timer0_milliseconds = { 0 };
  24. uint8_t timer0_fractional = 0;
  25. uint32_t Delay(uint32_t delay) {
  26. uint32_t t = milliseconds() + delay;
  27. while (milliseconds() < t);
  28. }
  29. uint32_t milliseconds() {
  30. uint32_t m;
  31. uint8_t oldSREG = SREG;
  32. cli();
  33. m = timer0_milliseconds.value;
  34. SREG = oldSREG;
  35. return m;
  36. }
  37. void InitClock() {
  38. Timer<0>::set_prescaler(3);
  39. Timer<0>::set_mode(TIMER_FAST_PWM);
  40. Timer<0>::Start();
  41. }
  42. } // namespace avrlib