scb-init.c 1.3 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253
  1. /*
  2. * arch/blackfin/mach-common/scb-init.c - reprogram system cross bar priority
  3. *
  4. * Copyright 2012 Analog Devices Inc.
  5. *
  6. * Licensed under the GPL-2 or later.
  7. */
  8. #include <linux/init.h>
  9. #include <linux/errno.h>
  10. #include <linux/kernel.h>
  11. #include <asm/scb.h>
  12. __attribute__((l1_text))
  13. inline void scb_mi_write(unsigned long scb_mi_arbw, unsigned int slots,
  14. unsigned char *scb_mi_prio)
  15. {
  16. unsigned int i;
  17. for (i = 0; i < slots; ++i)
  18. bfin_write32(scb_mi_arbw, (i << SCB_SLOT_OFFSET) | scb_mi_prio[i]);
  19. }
  20. __attribute__((l1_text))
  21. inline void scb_mi_read(unsigned long scb_mi_arbw, unsigned int slots,
  22. unsigned char *scb_mi_prio)
  23. {
  24. unsigned int i;
  25. for (i = 0; i < slots; ++i) {
  26. bfin_write32(scb_mi_arbw, (0xFF << SCB_SLOT_OFFSET) | i);
  27. scb_mi_prio[i] = bfin_read32(scb_mi_arbw);
  28. }
  29. }
  30. __attribute__((l1_text))
  31. void init_scb(void)
  32. {
  33. unsigned int i, j;
  34. unsigned char scb_tmp_prio[32];
  35. pr_info("Init System Crossbar\n");
  36. for (i = 0; scb_data[i].scb_mi_arbr > 0; ++i) {
  37. scb_mi_write(scb_data[i].scb_mi_arbw, scb_data[i].scb_mi_slots, scb_data[i].scb_mi_prio);
  38. pr_debug("scb priority at 0x%lx:\n", scb_data[i].scb_mi_arbr);
  39. scb_mi_read(scb_data[i].scb_mi_arbw, scb_data[i].scb_mi_slots, scb_tmp_prio);
  40. for (j = 0; j < scb_data[i].scb_mi_slots; ++j)
  41. pr_debug("slot %d = %d\n", j, scb_tmp_prio[j]);
  42. }
  43. }