release/src-rt-6.x.4708/cfe/cfe/arch/arm/board/bcm947xx/src/platform.c

   1 /*
   2 ** Copyright 2000, 2001  Broadcom Corporation
   3 ** All Rights Reserved
   4 **
   5 ** No portions of this material may be reproduced in any form
   6 ** without the written permission of:
   7 **
   8 **   Broadcom Corporation
   9 **   5300 California Avenue
  10 **   Irvine, California 92617
  11 **
  12 ** All information contained in this document is Broadcom
  13 ** Corporation company private proprietary, and trade secret.
  14 **
  15 ** ----------------------------------------------------------
  16 **
  17 **
  18 **
  19 ** $Id::                                                          $:
  20 ** $Rev::file =  : Global SVN Revision = 1780                     $:
  21 **
  22 */
  23
  24 /* platform.c
  25  *
  26  * Use those header files for the northstar build
  27  */
  28
  29 #include <typedefs.h>
  30 #include <bcmdefs.h>
  31 #include <osl.h>
  32 #include <bcmutils.h>
  33 #include <ddr_core.h>
  34
  35 #include <platform.h>
  36
  37 #define CACHE_LINE_SIZE   (32)
  38
  39 void flush_dcache_range(unsigned long start, unsigned long stop)
  40 {
  41         unsigned long i;
  42
  43         for (i = start; i < stop; i += CACHE_LINE_SIZE) {
  44                 asm volatile("MCR  p15, 0, %0, c7, c10, 1"::"r"(i));
  45         }
  46         asm volatile("MCR  p15, 0, r0, c7, c10, 4":::); /* DSB */
  47 }
  48
  49 void invalidate_dcache_range(unsigned long start, unsigned long stop)
  50 {
  51         unsigned long i;
  52
  53         for (i = start; i < stop; i += CACHE_LINE_SIZE) {
  54                 asm volatile("MCR  p15, 0, %0, c7, c6, 1"::"r"(i));
  55         }
  56
  57         asm volatile("MCR  p15, 0, r0, c7, c10, 4":::); /* DSB */
  58 }
  59
  60 void SHMOO_FLUSH_DATA_TO_DRAM(ddr40_addr_t Address, unsigned int bytes)
  61 {
  62         unsigned long const EndAddress = Address + bytes;
  63         flush_dcache_range(Address, EndAddress);
  64 }
  65
  66 void SHMOO_INVALIDATE_DATA_FROM_DRAM(ddr40_addr_t Address, unsigned int bytes)
  67 {
  68         unsigned long const EndAddress = Address + bytes;
  69         invalidate_dcache_range(Address, EndAddress);
  70 }
  71
  72 void UART_OUT(unsigned int val)
  73 {
  74         printf("%c", val);
  75 }
  76
  77 void plot_dec_number(unsigned int val)
  78 {
  79         printf("%08d", val);
  80 }
  81
  82 void plot_hex_number(unsigned int val)
  83 {
  84         printf("%08X", val);
  85 }
  86
  87 unsigned int tb_r(ddr40_addr_t Address)
  88 {
  89         unsigned int const Data = *(unsigned int *)Address;
  90
  91         return Data;
  92 }
  93
  94 void tb_w(ddr40_addr_t Address, unsigned int Data)
  95 {
  96         *(unsigned int *)Address = Data;
  97 }
  98
  99 unsigned int SHMOO_DRAM_READ_32(ddr40_addr_t Address)
 100 {
 101         return (*(unsigned int *)Address);
 102 }
 103
 104 void SHMOO_DRAM_WRITE_32(ddr40_addr_t Address, unsigned int Data)
 105 {
 106         *(unsigned int *)Address = Data;
 107 }
 108
 109 int rewrite_dram_mode_regs(void *sih)
 110 {
 111         return rewrite_mode_registers(sih);
 112 }
 113
 114 /*
 115  * Functions for the PHY init
 116  */
 117 void PrintfLog(char * const ptFormatStr, ...)
 118 {
 119         char __tmp_buf[128] = {'L', 'o', 'g', ':', ' '};
 120         va_list arg;
 121
 122         va_start(arg, ptFormatStr);
 123         vsprintf(&__tmp_buf[5], ptFormatStr, arg);
 124         va_end(arg);
 125
 126         printf(__tmp_buf);
 127 }
 128
 129 void PrintfErr(char * const ptFormatStr, ...)
 130 {
 131         char __tmp_buf[128] = {'E', 'r', 'r', 'o', 'r', ':', ' '};
 132         va_list arg;
 133
 134         va_start(arg, ptFormatStr);
 135         vsprintf(&__tmp_buf[7], ptFormatStr, arg);
 136         va_end(arg);
 137
 138         printf(__tmp_buf);
 139 }
 140
 141 void PrintfFatal(char * const ptFormatStr, ...)
 142 {
 143         char __tmp_buf[128] = {'F', 'a', 't', 'a', 'l', ':', ' '};
 144         va_list arg;
 145
 146         va_start(arg, ptFormatStr);
 147         vsprintf(&__tmp_buf[7], ptFormatStr, arg);
 148         va_end(arg);
 149
 150         printf(__tmp_buf);
 151 }