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.

44 lines
1.3KB

  1. // Copyright 2011 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 <avr/interrupt.h>
  21. #include <avr/io.h>
  22. #include "avrlibx/system/time.h"
  23. namespace avrlibx {
  24. volatile LongWord milliseconds_count = { 0 };
  25. void 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 = milliseconds_count.value;
  34. SREG = oldSREG;
  35. return m;
  36. }
  37. } // namespace avrlibx