release/src/shared/cfe_osl.c

   1 /*
   2  * CFE OS Independent Layer
   3  *
   4  * Copyright 2004, Broadcom Corporation
   5  * All Rights Reserved.
   6  *
   7  * THIS SOFTWARE IS OFFERED "AS IS", AND BROADCOM GRANTS NO WARRANTIES OF ANY
   8  * KIND, EXPRESS OR IMPLIED, BY STATUTE, COMMUNICATION OR OTHERWISE. BROADCOM
   9  * SPECIFICALLY DISCLAIMS ANY IMPLIED WARRANTIES OF MERCHANTABILITY, FITNESS
  10  * FOR A SPECIFIC PURPOSE OR NONINFRINGEMENT CONCERNING THIS SOFTWARE.
  11  *
  12  * $Id$
  13  */
  14
  15 #include <typedefs.h>
  16 #include <bcmdefs.h>
  17 #include <osl.h>
  18
  19 osl_t *
  20 osl_attach(void *pdev)
  21 {
  22         osl_t *osh;
  23
  24         osh = (osl_t *)KMALLOC(sizeof(osl_t), 0);
  25         ASSERT(osh);
  26
  27         bzero(osh, sizeof(osl_t));
  28         osh->pdev = pdev;
  29         return osh;
  30 }
  31
  32 void
  33 osl_detach(osl_t *osh)
  34 {
  35         if (osh == NULL)
  36                 return;
  37         KFREE((void*) KERNADDR(PHYSADDR((ulong)osh)));
  38 }
  39
  40 struct lbuf *
  41 osl_pktget(uint len)
  42 {
  43         uchar *buf;
  44         struct lbuf *lb;
  45
  46         ASSERT(len <= LBDATASZ);
  47
  48         if (!(buf = KMALLOC(LBUFSZ, 0)))
  49                 return NULL;
  50
  51         lb = (struct lbuf *) &buf[LBDATASZ];
  52         bzero(lb, sizeof(struct lbuf));
  53         lb->head = lb->data = buf;
  54         lb->end = buf + len;
  55         lb->len = len;
  56         lb->tail = lb->data + len;
  57
  58         return lb;
  59 }
  60
  61 void
  62 osl_pktfree(osl_t *osh, struct lbuf *lb, bool send)
  63 {
  64         struct lbuf *next;
  65
  66         if (send && osh->tx_fn)
  67                 osh->tx_fn(osh->tx_ctx, lb, 0);
  68
  69         for (; lb; lb = next) {
  70                 ASSERT(!lb->link);
  71                 next = lb->next;
  72                 KFREE((void *) KERNADDR(PHYSADDR((ulong) lb->head)));
  73         }
  74 }
  75
  76 struct lbuf *
  77 osl_pktdup(struct lbuf *lb)
  78 {
  79         struct lbuf *dup;
  80
  81         if (!(dup = osl_pktget(lb->len)))
  82                 return NULL;
  83
  84         bcopy(lb->data, dup->data, lb->len);
  85         ASSERT(!lb->link);
  86
  87         return dup;
  88 }
  89
  90 void
  91 osl_pktsetlen(struct lbuf *lb, uint len)
  92 {
  93         ASSERT((lb->data + len) <= lb->end);
  94
  95         lb->len = len;
  96         lb->tail = lb->data + len;
  97 }
  98
  99 uchar *
 100 osl_pktpush(struct lbuf *lb, uint bytes)
 101 {
 102         ASSERT((lb->data - bytes) >= lb->head);
 103
 104         lb->data -= bytes;
 105         lb->len += bytes;
 106
 107         return lb->data;
 108 }
 109
 110 uchar *
 111 osl_pktpull(struct lbuf *lb, uint bytes)
 112 {
 113         ASSERT((lb->data + bytes) <= lb->end);
 114         ASSERT(lb->len >= bytes);
 115
 116         lb->data += bytes;
 117         lb->len -= bytes;
 118
 119         return lb->data;
 120 }
 121
 122 void *
 123 osl_dma_alloc_consistent(uint size, ulong *pap)
 124 {
 125         void *buf;
 126
 127         if (!(buf = KMALLOC(size, DMA_CONSISTENT_ALIGN)))
 128                 return NULL;
 129
 130         *((ulong *) pap) = PHYSADDR((ulong) buf);
 131
 132         cfe_flushcache(CFE_CACHE_FLUSH_D);
 133
 134         return (void *) UNCADDR((ulong) buf);
 135 }
 136
 137 void
 138 osl_dma_free_consistent(void *va)
 139 {
 140         KFREE((void *) KERNADDR(PHYSADDR((ulong) va)));
 141 }
 142
 143 #ifdef BCMDBG_ASSERT
 144 void
 145 osl_assert(char *exp, char *file, int line)
 146 {
 147         printf("assertion \"%s\" failed: file \"%s\", line %d\n", exp, file, line);
 148         *((int *) 0) = 0;
 149 }
 150 #endif /* BCMDBG_ASSERT */
 151
 152 int
 153 osl_busprobe(uint32 *val, uint32 addr)
 154 {
 155         *val = R_REG(NULL, (volatile uint32 *) addr);
 156
 157         return 0;
 158 }
 159
 160 /* translate bcmerros */
 161 int
 162 osl_error(int bcmerror)
 163 {
 164         if (bcmerror)
 165                 return -1;
 166         else
 167         return 0;
 168 }
 169
 170 /* Converts a OS packet to driver packet.
 171  * The original packet data is copied to the new driver packet
 172  */
 173 void
 174 osl_pkt_frmnative(iocb_buffer_t *buffer, struct lbuf *lb)
 175 {
 176         bcopy(buffer->buf_ptr, PKTDATA(NULL, lb), buffer->buf_length);
 177 }
 178
 179 /* Converts a driver packet into OS packet.
 180  * The data is copied to the OS packet
 181  */
 182 void
 183 osl_pkt_tonative(struct lbuf* lb, iocb_buffer_t *buffer)
 184 {
 185         bcopy(PKTDATA(NULL, lb), buffer->buf_ptr, PKTLEN(NULL, lb));
 186         buffer->buf_retlen = PKTLEN(NULL, lb);
 187
 188         /* RFC894: Minimum length of IP over Ethernet packet is 46 octets */
 189         if (buffer->buf_retlen < 60) {
 190                 bzero(buffer->buf_ptr + buffer->buf_retlen, 60 - buffer->buf_retlen);
 191                 buffer->buf_retlen = 60;
 192         }
 193 }