bootcount_ram.c 1.6 KB

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