bootcount_ram.c 1.5 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364
  1. /*
  2. * (C) Copyright 2010
  3. * Heiko Schocher, DENX Software Engineering, hs@denx.de.
  4. *
  5. * SPDX-License-Identifier: GPL-2.0+
  6. */
  7. #include <common.h>
  8. #include <asm/io.h>
  9. DECLARE_GLOBAL_DATA_PTR;
  10. const ulong patterns[] = { 0x00000000,
  11. 0xFFFFFFFF,
  12. 0xFF00FF00,
  13. 0x0F0F0F0F,
  14. 0xF0F0F0F0};
  15. const ulong NBR_OF_PATTERNS = sizeof(patterns) / sizeof(*patterns);
  16. const ulong OFFS_PATTERN = 3;
  17. const ulong REPEAT_PATTERN = 1000;
  18. void bootcount_store(ulong a)
  19. {
  20. ulong *save_addr;
  21. ulong size = 0;
  22. int i;
  23. for (i = 0; i < CONFIG_NR_DRAM_BANKS; i++)
  24. size += gd->bd->bi_dram[i].size;
  25. save_addr = (ulong *)(size - BOOTCOUNT_ADDR);
  26. writel(a, save_addr);
  27. writel(BOOTCOUNT_MAGIC, &save_addr[1]);
  28. for (i = 0; i < REPEAT_PATTERN; i++)
  29. writel(patterns[i % NBR_OF_PATTERNS],
  30. &save_addr[i + OFFS_PATTERN]);
  31. /* Make sure the data is written to RAM */
  32. flush_dcache_range((ulong)&save_addr[0],
  33. (((ulong)&save_addr[REPEAT_PATTERN + OFFS_PATTERN] &
  34. ~(ARCH_DMA_MINALIGN - 1)) + ARCH_DMA_MINALIGN));
  35. }
  36. ulong bootcount_load(void)
  37. {
  38. ulong *save_addr;
  39. ulong size = 0;
  40. ulong counter = 0;
  41. int i, tmp;
  42. for (i = 0; i < CONFIG_NR_DRAM_BANKS; i++)
  43. size += gd->bd->bi_dram[i].size;
  44. save_addr = (ulong *)(size - BOOTCOUNT_ADDR);
  45. counter = readl(&save_addr[0]);
  46. /* Is the counter reliable, check in the big pattern for bit errors */
  47. for (i = 0; (i < REPEAT_PATTERN) && (counter != 0); i++) {
  48. tmp = readl(&save_addr[i + OFFS_PATTERN]);
  49. if (tmp != patterns[i % NBR_OF_PATTERNS])
  50. counter = 0;
  51. }
  52. return counter;
  53. }