board/evb64260/zuma_pbb_mbox.c

   1 #include <common.h>
   2 #include <galileo/pci.h>
   3 #include <net.h>
   4 #include <pci.h>
   5
   6 #include "zuma_pbb.h"
   7 #include "zuma_pbb_mbox.h"
   8
   9
  10 struct _zuma_mbox_dev zuma_mbox_dev;
  11
  12
  13 static int zuma_mbox_write(struct _zuma_mbox_dev *dev, unsigned int data)
  14 {
  15   unsigned int status, count = 0, i;
  16
  17   status = (volatile int)le32_to_cpu(dev->sip->mbox_status);
  18
  19   while((status & OUT_PENDING) && count < 1000) {
  20     count++;
  21     for(i=0;i<1000;i++);
  22     status = (volatile int)le32_to_cpu(dev->sip->mbox_status);
  23   }
  24   if(count < 1000) {
  25     /* if SET it means msg pending */
  26     /* printf("mbox real write %08x\n",data); */
  27     dev->sip->mbox_out = cpu_to_le32(data);
  28     return 4;
  29   }
  30
  31   printf("mbox tx timeout\n");
  32   return 0;
  33 }
  34
  35 static int zuma_mbox_read(struct _zuma_mbox_dev *dev, unsigned int *data)
  36 {
  37   unsigned int status, count = 0, i;
  38
  39   status = (volatile int)le32_to_cpu(dev->sip->mbox_status);
  40
  41   while(!(status & IN_VALID) && count < 1000) {
  42     count++;
  43     for(i=0;i<1000;i++);
  44     status = (volatile int)le32_to_cpu(dev->sip->mbox_status);
  45   }
  46   if(count < 1000) {
  47     /* if SET it means msg pending */
  48     *data=le32_to_cpu(dev->sip->mbox_in);
  49     /*printf("mbox real read %08x\n", *data); */
  50     return 4;
  51   }
  52   printf("mbox rx timeout\n");
  53   return 0;
  54 }
  55
  56 static int zuma_mbox_do_one_mailbox(unsigned int out, unsigned int *in)
  57 {
  58   int ret;
  59   ret=zuma_mbox_write(&zuma_mbox_dev,out);
  60   /*printf("write 0x%08x (%d bytes)\n", out, ret); */
  61   if(ret!=4) return -1;
  62   ret=zuma_mbox_read(&zuma_mbox_dev,in);
  63   /*printf("read 0x%08x (%d bytes)\n", *in, ret); */
  64   if(ret!=4) return -1;
  65   return 0;
  66 }
  67
  68
  69 #define RET_IF_FAILED(x)        if ((x) == -1) return -1
  70
  71 static int zuma_mbox_do_all_mailbox(void)
  72 {
  73   unsigned int data_in;
  74   unsigned short sdata_in;
  75
  76   RET_IF_FAILED(zuma_mbox_do_one_mailbox(ZUMA_MBOXMSG_START, &data_in));
  77
  78   RET_IF_FAILED(zuma_mbox_do_one_mailbox(ZUMA_MBOXMSG_MACL, &data_in));
  79   memcpy(zuma_acc_mac+2,&data_in,4);
  80   RET_IF_FAILED(zuma_mbox_do_one_mailbox(ZUMA_MBOXMSG_MACH, &data_in));
  81   sdata_in=data_in&0xffff;
  82   memcpy(zuma_acc_mac,&sdata_in,2);
  83
  84   RET_IF_FAILED(zuma_mbox_do_one_mailbox(ZUMA_MBOXMSG_IP, &data_in));
  85   zuma_ip=data_in;
  86
  87   RET_IF_FAILED(zuma_mbox_do_one_mailbox(ZUMA_MBOXMSG_SLOT, &data_in));
  88   zuma_slot_bac=data_in>>3;
  89
  90   RET_IF_FAILED(zuma_mbox_do_one_mailbox(ZUMA_MBOXMSG_BAUD, &data_in));
  91   zuma_console_baud = data_in & 0xffff;
  92   zuma_debug_baud   = data_in >> 16;
  93
  94   RET_IF_FAILED(zuma_mbox_do_one_mailbox(ZUMA_MBOXMSG_ENG_PRV_MACL, &data_in));
  95   memcpy(zuma_prv_mac+2,&data_in,4);
  96   RET_IF_FAILED(zuma_mbox_do_one_mailbox(ZUMA_MBOXMSG_ENG_PRV_MACH, &data_in));
  97   sdata_in=data_in&0xffff;
  98   memcpy(zuma_prv_mac,&sdata_in,2);
  99
 100   RET_IF_FAILED(zuma_mbox_do_one_mailbox(ZUMA_MBOXMSG_DONE, &data_in));
 101
 102   return 0;
 103 }
 104
 105
 106 static void
 107 zuma_mbox_dump(void)
 108 {
 109   printf("ACC MAC=%04x%08x\n",*(unsigned short *)(&zuma_acc_mac),*(unsigned int *)((char *)&zuma_acc_mac+2));
 110   printf("PRV MAC=%04x%08x\n",*(unsigned short *)(&zuma_prv_mac),*(unsigned int *)((char *)&zuma_prv_mac+2));
 111   printf("slot:bac=%d:%d\n",(zuma_slot_bac>>2)&0xf, zuma_slot_bac & 0x3);
 112   printf("BAUD1=%d BAUD2=%d\n",zuma_console_baud,zuma_debug_baud);
 113 }
 114
 115
 116 static void
 117 zuma_mbox_setenv(void)
 118 {
 119   char *data, buf[32];
 120   unsigned char save = 0;
 121
 122   data = getenv("baudrate");
 123
 124   if(!data || (zuma_console_baud != simple_strtoul(data, NULL, 10))) {
 125     sprintf(buf, "%6d", zuma_console_baud);
 126     setenv("baudrate", buf);
 127     save=1;
 128     printf("baudrate doesn't match from mbox\n");
 129   }
 130
 131   ip_to_string(zuma_ip, buf);
 132   setenv("ipaddr", buf);
 133
 134   sprintf(buf,"%02x:%02x:%02x:%02x:%02x:%02x",
 135           zuma_prv_mac[0],
 136           zuma_prv_mac[1],
 137           zuma_prv_mac[2],
 138           zuma_prv_mac[3],
 139           zuma_prv_mac[4],
 140           zuma_prv_mac[5]);
 141   setenv("ethaddr", buf);
 142
 143   sprintf(buf,"%02x",zuma_slot_bac);
 144   setenv("bacslot", buf);
 145
 146   if(save)
 147     saveenv();
 148 }
 149
 150 /**
 151  *      zuma_mbox_init:
 152  */
 153
 154 int zuma_mbox_init(void)
 155 {
 156   unsigned int iobase;
 157   memset(&zuma_mbox_dev, 0, sizeof(struct _zuma_mbox_dev));
 158
 159   zuma_mbox_dev.dev = pci_find_device(VENDOR_ID_ZUMA, DEVICE_ID_ZUMA_PBB, 0);
 160
 161   if(zuma_mbox_dev.dev == -1) {
 162     printf("no zuma pbb\n");
 163     return -1;
 164   }
 165
 166   pci_read_config_dword(zuma_mbox_dev.dev, PCI_BASE_ADDRESS_0, &iobase);
 167
 168   iobase &= PCI_BASE_ADDRESS_MEM_MASK;
 169
 170   zuma_mbox_dev.sip = (PBB_DMA_REG_MAP *)iobase;
 171
 172   zuma_mbox_dev.sip->int_mask.word=0;
 173
 174   printf("pbb @ %p v%d.%d, timestamp %08x\n", zuma_mbox_dev.sip,
 175          zuma_mbox_dev.sip->version.pci_bits.rev_major,
 176          zuma_mbox_dev.sip->version.pci_bits.rev_minor,
 177          zuma_mbox_dev.sip->timestamp);
 178
 179   if (zuma_mbox_do_all_mailbox() == -1) {
 180           printf("mailbox failed.. no ACC?\n");
 181           return -1;
 182   }
 183
 184   zuma_mbox_dump();
 185
 186   zuma_mbox_setenv();
 187
 188   return 0;
 189 }