cpu/mips/jz4740_cpm_test.c

   1 #include <config.h>
   2
   3 #ifdef CONFIG_JZ4740
   4 #include <common.h>
   5 #include <command.h>
   6 #include <asm/jz4740.h>
   7 #include <asm/io.h>               /* virt_to_phys() */
   8 #define JZ4740_CPM_TEST
   9
  10
  11
  12 int cpm_value;
  13 void mdelay(int dly)
  14 {
  15         udelay(dly * 1000);
  16 }
  17
  18 int myatoi(char *string)
  19 {
  20     int res = 0;
  21     while (*string>='0' && *string <='9')
  22     {
  23         res *= 10;
  24         res += *string-'0';
  25         string++;
  26     }
  27
  28     return res;
  29 }
  30
  31 int myhatoi(char *string)
  32 {
  33     int res = 0;
  34
  35     if ( *string != '0' || *(string+1) != 'x' ) {
  36             return 0;
  37     }
  38
  39     string += 2;
  40
  41     while ( *string )
  42     {
  43         res *= 16;
  44         if (*string>='0' && *string <='9')
  45                 res += *string-'0';
  46         else if (*string>='a' && *string <='f')
  47                 res += *string-'a' + 10;
  48         else
  49                 return res;
  50
  51         string++;
  52     }
  53
  54     return res;
  55 }
  56
  57 int atoi( char * string )
  58 {
  59     if ( *string == '0' && *(string+1) == 'x' ) {
  60             return myhatoi(string);
  61     }
  62     else
  63             return myatoi(string);
  64 }
  65
  66 void cpm_add_test(void)
  67 {
  68         pll_add_test(cpm_value);
  69         //sdram_add_test(cpm_value);
  70         calc_clocks_add_test();
  71 }
  72
  73 int do_jz_cpmtest_function(cmd_tbl_t *cmdtp, int flag, int argc, char *argv[])
  74 {
  75
  76         if ( !strncmp(argv[1], "add", 3 ) ) {
  77                 if ( argc == 3 ) {
  78                         cpm_value = atoi( argv[2] );
  79                         printf("cpm value:%d\n",cpm_value);
  80                         if((cpm_value >= 999) || (cpm_value <= 100)) {
  81                                 printf("param is wrong!\n");
  82                         }
  83                         cpm_value *= 1000000;
  84                         cpm_add_test();
  85                 }
  86         } else {
  87                 printf("command is wrong!\n");
  88         }
  89         return 0;
  90 }
  91
  92 U_BOOT_CMD(
  93         cpm,    4,      1,      do_jz_cpmtest_function,
  94         "cpm:\t - Usage: cpmtest [add][cpm_value]\n",
  95         NULL
  96         );
  97
  98 #endif /* CONFIG_JZ4740 */