adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 1 | /* |
| 2 | * uIP lan91c96 (smc9194) driver |
| 3 | * Based on cs8900a driver, copyrighted (c) 2001, by Adam Dunkels |
| 4 | * Copyright (c) 2003, Josef Soucek |
| 5 | * All rights reserved. |
| 6 | * |
| 7 | * Ethernet card for Commodore 64, based on lan91c96 chip |
| 8 | * is a device created by IDE64 Project team. |
| 9 | * More information: http://ide64.come.to |
| 10 | * |
| 11 | * Redistribution and use in source and binary forms, with or without |
| 12 | * modification, are permitted provided that the following conditions |
| 13 | * are met: |
| 14 | * 1. Redistributions of source code must retain the above copyright |
| 15 | * notice, this list of conditions and the following disclaimer. |
| 16 | * 2. Redistributions in binary form must reproduce the above copyright |
| 17 | * notice, this list of conditions and the following disclaimer in the |
| 18 | * documentation and/or other materials provided with the distribution. |
| 19 | * 3. The name of the author may not be used to endorse or promote |
| 20 | * products derived from this software without specific prior |
| 21 | * written permission. |
| 22 | * |
| 23 | * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS |
| 24 | * OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED |
| 25 | * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE |
| 26 | * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY |
| 27 | * DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL |
| 28 | * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE |
| 29 | * GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS |
| 30 | * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, |
| 31 | * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING |
| 32 | * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS |
| 33 | * SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. |
| 34 | * |
oliverschmidt | 6b786ba | 2005-03-10 00:53:07 +0000 | [diff] [blame^] | 35 | * $Id: lan91c96.c,v 1.9 2005/03/10 00:53:07 oliverschmidt Exp $ |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 36 | * |
| 37 | */ |
| 38 | |
adamdunkels | 0a08fda | 2004-07-04 18:33:07 +0000 | [diff] [blame] | 39 | #define UIP_ETHADDR0 0x00 |
| 40 | #define UIP_ETHADDR1 0x0d |
| 41 | #define UIP_ETHADDR2 0x60 |
| 42 | #define UIP_ETHADDR3 0x80 |
| 43 | #define UIP_ETHADDR4 0x3d |
| 44 | #define UIP_ETHADDR5 0xb9 |
| 45 | |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 46 | #include "lan91c96.h" |
| 47 | #include "uip.h" |
| 48 | #include "uip_arp.h" |
| 49 | |
| 50 | #include <stdio.h> |
| 51 | |
| 52 | // #define DEBUG |
| 53 | |
| 54 | #define ETHBASE 0xde10 |
| 55 | |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 56 | #define ETHBSR ETHBASE+0x0e /* Bank select register R/W (2B) */ |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 57 | |
| 58 | /* Register bank 0 */ |
| 59 | |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 60 | #define ETHTCR ETHBASE /* Transmition control register R/W (2B) */ |
| 61 | #define ETHEPHSR ETHBASE+2 /* EPH status register R/O (2B) */ |
| 62 | #define ETHRCR ETHBASE+4 /* Receive control register R/W (2B) */ |
| 63 | #define ETHECR ETHBASE+6 /* Counter register R/O (2B) */ |
| 64 | #define ETHMIR ETHBASE+8 /* Memory information register R/O (2B) */ |
| 65 | #define ETHMCR ETHBASE+0x0a /* Memory Config. reg. +0 R/W +1 R/O (2B) */ |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 66 | |
| 67 | /* Register bank 1 */ |
| 68 | |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 69 | #define ETHCR ETHBASE /* Configuration register R/W (2B) */ |
| 70 | #define ETHBAR ETHBASE+2 /* Base address register R/W (2B) */ |
| 71 | #define ETHIAR ETHBASE+4 /* Individual address register R/W (6B) */ |
| 72 | #define ETHGPR ETHBASE+0x0a /* General address register R/W (2B) */ |
| 73 | #define ETHCTR ETHBASE+0x0c /* Control register R/W (2B) */ |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 74 | |
| 75 | /* Register bank 2 */ |
| 76 | |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 77 | #define ETHMMUCR ETHBASE /* MMU command register W/O (1B) */ |
| 78 | #define ETHAUTOTX ETHBASE+1 /* AUTO TX start register R/W (1B) */ |
| 79 | #define ETHPNR ETHBASE+2 /* Packet number register R/W (1B) */ |
| 80 | #define ETHARR ETHBASE+3 /* Allocation result register R/O (1B) */ |
| 81 | #define ETHFIFO ETHBASE+4 /* FIFO ports register R/O (2B) */ |
| 82 | #define ETHPTR ETHBASE+6 /* Pointer register R/W (2B) */ |
| 83 | #define ETHDATA ETHBASE+8 /* Data register R/W (4B) */ |
| 84 | #define ETHIST ETHBASE+0x0c /* Interrupt status register R/O (1B) */ |
| 85 | #define ETHACK ETHBASE+0x0c /* Interrupt acknowledge register W/O (1B) */ |
| 86 | #define ETHMSK ETHBASE+0x0d /* Interrupt mask register R/W (1B) */ |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 87 | |
| 88 | /* Register bank 3 */ |
| 89 | |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 90 | #define ETHMT ETHBASE /* Multicast table R/W (8B) */ |
| 91 | #define ETHMGMT ETHBASE+8 /* Management interface R/W (2B) */ |
| 92 | #define ETHREV ETHBASE+0x0a /* Revision register R/W (2B) */ |
| 93 | #define ETHERCV ETHBASE+0x0c /* Early RCV register R/W (2B) */ |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 94 | |
| 95 | #define BANK(num) asm("lda #%b",num); asm("sta %w",ETHBSR); |
| 96 | |
| 97 | #ifdef DEBUG |
| 98 | static void print_packet(u8_t *, u16_t); |
| 99 | #endif |
| 100 | |
| 101 | static u8_t packet_status; |
| 102 | static u16_t packet_length; |
| 103 | |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 104 | |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 105 | /*-----------------------------------------------------------------------------------*/ |
oliverschmidt | a8240ea | 2004-07-18 13:19:47 +0000 | [diff] [blame] | 106 | #pragma optimize(push, off) |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 107 | void lan91c96_init(void) |
| 108 | { |
| 109 | /* Check if high byte is 0x33 */ |
| 110 | asm("lda %w", ETHBSR+1); |
| 111 | asm("cmp #$33"); |
oliverschmidt | 6b786ba | 2005-03-10 00:53:07 +0000 | [diff] [blame^] | 112 | asm("beq %g", L1); |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 113 | |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 114 | asm("inc $d021"); /* Error */ |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 115 | |
oliverschmidt | 6b786ba | 2005-03-10 00:53:07 +0000 | [diff] [blame^] | 116 | L1: |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 117 | |
| 118 | /* Reset ETH card */ |
| 119 | BANK(0); |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 120 | asm("lda #%%10000000"); /* Software reset */ |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 121 | asm("sta %w", ETHRCR+1); |
| 122 | |
| 123 | asm("lda #0"); |
| 124 | asm("sta %w", ETHRCR); |
| 125 | asm("sta %w", ETHRCR+1); |
| 126 | |
| 127 | /* delay */ |
| 128 | asm("ldx #0"); |
oliverschmidt | 6b786ba | 2005-03-10 00:53:07 +0000 | [diff] [blame^] | 129 | L2: |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 130 | asm("cmp ($ff,x)"); /* 6 cycles */ |
| 131 | asm("cmp ($ff,x)"); /* 6 cycles */ |
| 132 | asm("dex"); /* 2 cycles */ |
oliverschmidt | 6b786ba | 2005-03-10 00:53:07 +0000 | [diff] [blame^] | 133 | asm("bne %g", L2); /* 3 cycles */ |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 134 | /* 17*256=4352 => 4,4 ms */ |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 135 | |
| 136 | /* Enable transmit and receive */ |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 137 | asm("lda #%%10000001"); /* Enable transmit TXENA, PAD_EN */ |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 138 | asm("sta %w", ETHTCR); |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 139 | asm("lda #%%00000011"); /* Enable receive, strip CRC ??? */ |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 140 | asm("sta %w", ETHRCR+1); |
| 141 | |
| 142 | BANK(1); |
| 143 | asm("lda %w", ETHCR+1); |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 144 | asm("ora #%%00010000"); /* No wait (IOCHRDY) */ |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 145 | asm("sta %w", ETHCR+1); |
| 146 | |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 147 | asm("lda #%%00001001"); /* Auto release */ |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 148 | asm("sta %w", ETHCTR+1); |
| 149 | |
| 150 | /* Set MAC address */ |
| 151 | asm("lda #%b", (unsigned)UIP_ETHADDR0); |
| 152 | asm("sta %w", ETHIAR); |
| 153 | asm("lda #%b", (unsigned)UIP_ETHADDR1); |
| 154 | asm("sta %w", ETHIAR+1); |
| 155 | asm("lda #%b", (unsigned)UIP_ETHADDR2); |
| 156 | asm("sta %w", ETHIAR+2); |
| 157 | asm("lda #%b", (unsigned)UIP_ETHADDR3); |
| 158 | asm("sta %w", ETHIAR+3); |
| 159 | asm("lda #%b", (unsigned)UIP_ETHADDR4); |
| 160 | asm("sta %w", ETHIAR+4); |
| 161 | asm("lda #%b", (unsigned)UIP_ETHADDR5); |
| 162 | asm("sta %w", ETHIAR+5); |
| 163 | |
| 164 | BANK(2); |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 165 | asm("lda #%%00001111"); /* RCV INT, ALLOC INT, TX INT, TX EMPTY */ |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 166 | asm("sta %w", ETHMSK); |
| 167 | } |
oliverschmidt | a8240ea | 2004-07-18 13:19:47 +0000 | [diff] [blame] | 168 | #pragma optimize(pop) |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 169 | /*-----------------------------------------------------------------------------------*/ |
oliverschmidt | a8240ea | 2004-07-18 13:19:47 +0000 | [diff] [blame] | 170 | #pragma optimize(push, off) |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 171 | u16_t lan91c96_poll(void) |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 172 | { |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 173 | #ifdef DEBUG |
| 174 | BANK(0); |
| 175 | printf("RAM: %d ", ((*(unsigned int *)(ETHMIR)) & 0xff00)); |
| 176 | BANK(2); |
| 177 | #endif |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 178 | |
| 179 | asm("lda %w", ETHIST); |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 180 | asm("and #%%00000001"); /* RCV INT */ |
oliverschmidt | 6b786ba | 2005-03-10 00:53:07 +0000 | [diff] [blame^] | 181 | asm("bne %g", L1); |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 182 | |
| 183 | /* No packet available */ |
| 184 | return 0; |
| 185 | |
oliverschmidt | 6b786ba | 2005-03-10 00:53:07 +0000 | [diff] [blame^] | 186 | L1: |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 187 | |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 188 | #ifdef DEBUG |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 189 | printf("RCV: IRQ\n"); |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 190 | #endif |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 191 | |
| 192 | asm("lda #0"); |
| 193 | asm("sta %w", ETHPTR); |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 194 | asm("lda #%%11100000"); /* RCV,AUTO INCR.,READ */ |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 195 | asm("sta %w", ETHPTR+1); |
| 196 | |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 197 | asm("lda %w", ETHDATA); /* Status word */ |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 198 | asm("lda %w", ETHDATA); |
oliverschmidt | 6b786ba | 2005-03-10 00:53:07 +0000 | [diff] [blame^] | 199 | asm("sta %v", packet_status); /* High byte only */ |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 200 | |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 201 | asm("lda %w", ETHDATA); /* Total number of bytes */ |
oliverschmidt | 6b786ba | 2005-03-10 00:53:07 +0000 | [diff] [blame^] | 202 | asm("sta %v", packet_length); |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 203 | asm("lda %w", ETHDATA); |
oliverschmidt | 6b786ba | 2005-03-10 00:53:07 +0000 | [diff] [blame^] | 204 | asm("sta %v+1", packet_length); |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 205 | |
| 206 | /* Last word contain 'last data byte' and 0x60 */ |
| 207 | /* or 'fill byte' and 0x40 */ |
| 208 | |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 209 | packet_length -= 6; /* The packet contains 3 extra words */ |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 210 | |
oliverschmidt | 6b786ba | 2005-03-10 00:53:07 +0000 | [diff] [blame^] | 211 | asm("lda %v", packet_status); |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 212 | asm("and #$10"); |
oliverschmidt | 6b786ba | 2005-03-10 00:53:07 +0000 | [diff] [blame^] | 213 | asm("beq %g", L2); |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 214 | |
| 215 | packet_length++; |
| 216 | |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 217 | #ifdef DEBUG |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 218 | printf("RCV: odd number of bytes\n"); |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 219 | #endif |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 220 | |
oliverschmidt | 6b786ba | 2005-03-10 00:53:07 +0000 | [diff] [blame^] | 221 | L2: |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 222 | |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 223 | #ifdef DEBUG |
oliverschmidt | 6b786ba | 2005-03-10 00:53:07 +0000 | [diff] [blame^] | 224 | printf("RCV: L:%d ST-HIGH:0x%02x ", packet_length, packet_status); |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 225 | #endif |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 226 | |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 227 | if(packet_length > UIP_BUFSIZE) { |
| 228 | |
| 229 | /* Remove and release RX packet from FIFO */ |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 230 | asm("lda #%%10000000"); |
| 231 | asm("sta %w", ETHMMUCR); |
| 232 | |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 233 | #ifdef DEBUG |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 234 | printf("RCV: UIP_BUFSIZE exceeded - packet dropped!\n"); |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 235 | #endif |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 236 | |
| 237 | return 0; |
| 238 | } |
| 239 | |
oliverschmidt | 6b786ba | 2005-03-10 00:53:07 +0000 | [diff] [blame^] | 240 | asm("lda #<%v", uip_buf); |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 241 | asm("sta ptr1"); |
oliverschmidt | 6b786ba | 2005-03-10 00:53:07 +0000 | [diff] [blame^] | 242 | asm("lda #>%v", uip_buf); |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 243 | asm("sta ptr1+1"); |
| 244 | |
| 245 | asm("ldy #0"); |
oliverschmidt | 6b786ba | 2005-03-10 00:53:07 +0000 | [diff] [blame^] | 246 | asm("ldx %v+1", packet_length); |
| 247 | asm("beq %g", RE1); /* packet_length < 256 */ |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 248 | |
oliverschmidt | 6b786ba | 2005-03-10 00:53:07 +0000 | [diff] [blame^] | 249 | RL1: |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 250 | asm("lda %w", ETHDATA); |
| 251 | asm("sta (ptr1),y"); |
| 252 | asm("iny"); |
oliverschmidt | 6b786ba | 2005-03-10 00:53:07 +0000 | [diff] [blame^] | 253 | asm("bne %g", RL1); |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 254 | asm("inc ptr1+1"); |
| 255 | asm("dex"); |
oliverschmidt | 6b786ba | 2005-03-10 00:53:07 +0000 | [diff] [blame^] | 256 | asm("bne %g", RL1); |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 257 | |
oliverschmidt | 6b786ba | 2005-03-10 00:53:07 +0000 | [diff] [blame^] | 258 | RE1: |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 259 | asm("lda %w", ETHDATA); |
| 260 | asm("sta (ptr1),y"); |
| 261 | asm("iny"); |
oliverschmidt | 6b786ba | 2005-03-10 00:53:07 +0000 | [diff] [blame^] | 262 | asm("cpy %v", packet_length); |
| 263 | asm("bne %g", RE1); |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 264 | |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 265 | /* Remove and release RX packet from FIFO */ |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 266 | asm("lda #%%10000000"); |
| 267 | asm("sta %w", ETHMMUCR); |
| 268 | |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 269 | #ifdef DEBUG |
| 270 | print_packet(uip_buf, packet_length); |
| 271 | #endif |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 272 | |
| 273 | return packet_length; |
| 274 | } |
oliverschmidt | a8240ea | 2004-07-18 13:19:47 +0000 | [diff] [blame] | 275 | #pragma optimize(pop) |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 276 | /*-----------------------------------------------------------------------------------*/ |
oliverschmidt | a8240ea | 2004-07-18 13:19:47 +0000 | [diff] [blame] | 277 | #pragma optimize(push, off) |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 278 | void lan91c96_send(void) |
| 279 | { |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 280 | /* First 14+40 (IP and TCP header) is send from uip_buf */ |
| 281 | /* than data from uip_appdata */ |
| 282 | |
| 283 | #ifdef DEBUG |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 284 | printf("SND: send packet\n"); |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 285 | #endif |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 286 | |
oliverschmidt | 6b786ba | 2005-03-10 00:53:07 +0000 | [diff] [blame^] | 287 | asm("lda %v+1", uip_len); |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 288 | asm("ora #%%00100000"); /* Allocate memory for TX */ |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 289 | asm("sta %w", ETHMMUCR); |
| 290 | |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 291 | asm("ldx #8"); /* Wait... */ |
oliverschmidt | 6b786ba | 2005-03-10 00:53:07 +0000 | [diff] [blame^] | 292 | L1: /* Wait for allocation ready */ |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 293 | asm("lda %w", ETHIST); |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 294 | asm("and #%%00001000"); /* ALLOC INT */ |
oliverschmidt | 6b786ba | 2005-03-10 00:53:07 +0000 | [diff] [blame^] | 295 | asm("bne %g", X1); |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 296 | asm("dex"); |
oliverschmidt | 6b786ba | 2005-03-10 00:53:07 +0000 | [diff] [blame^] | 297 | asm("bne %g", L1); |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 298 | |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 299 | #ifdef DEBUG |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 300 | printf("SND: ERR: memory alloc timeout\n"); |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 301 | #endif |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 302 | |
| 303 | return; |
| 304 | |
oliverschmidt | 6b786ba | 2005-03-10 00:53:07 +0000 | [diff] [blame^] | 305 | X1: |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 306 | #ifdef DEBUG |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 307 | printf("SND: packet memory allocated\n"); |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 308 | #endif |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 309 | |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 310 | asm("lda #%%00001000"); /* Acknowledge int, is it necessary ??? */ |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 311 | asm("sta %w", ETHACK); |
| 312 | |
| 313 | asm("lda %w", ETHARR); |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 314 | asm("sta %w", ETHPNR); /* Set packet address */ |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 315 | |
| 316 | asm("lda #0"); |
| 317 | asm("sta %w", ETHPTR); |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 318 | asm("lda #%%01000000"); /* AUTO INCR. */ |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 319 | asm("sta %w", ETHPTR+1); |
| 320 | |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 321 | #ifdef DEBUG |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 322 | printf("SND: L:%d ", uip_len); |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 323 | #endif |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 324 | |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 325 | asm("lda #0"); /* Status written by CSMA */ |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 326 | asm("sta %w", ETHDATA); |
| 327 | asm("sta %w", ETHDATA); |
| 328 | |
oliverschmidt | 6b786ba | 2005-03-10 00:53:07 +0000 | [diff] [blame^] | 329 | asm("lda %v", uip_len); |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 330 | asm("and #$01"); |
oliverschmidt | 6b786ba | 2005-03-10 00:53:07 +0000 | [diff] [blame^] | 331 | asm("beq %g", SD1); |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 332 | |
oliverschmidt | 6b786ba | 2005-03-10 00:53:07 +0000 | [diff] [blame^] | 333 | packet_length = uip_len + 5; |
| 334 | asm("jmp %g", LC1); |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 335 | |
oliverschmidt | 6b786ba | 2005-03-10 00:53:07 +0000 | [diff] [blame^] | 336 | SD1: |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 337 | |
oliverschmidt | 6b786ba | 2005-03-10 00:53:07 +0000 | [diff] [blame^] | 338 | packet_length = uip_len + 6; /* +6 for status word, length and ctl byte */ |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 339 | |
oliverschmidt | 6b786ba | 2005-03-10 00:53:07 +0000 | [diff] [blame^] | 340 | LC1: |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 341 | |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 342 | #ifdef DEBUG |
| 343 | printf("SND: L:%d ", packet_length); |
| 344 | #endif |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 345 | |
oliverschmidt | 6b786ba | 2005-03-10 00:53:07 +0000 | [diff] [blame^] | 346 | asm("lda %v", packet_length); |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 347 | asm("sta %w", ETHDATA); |
oliverschmidt | 6b786ba | 2005-03-10 00:53:07 +0000 | [diff] [blame^] | 348 | asm("lda %v+1", packet_length); |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 349 | asm("sta %w", ETHDATA); |
| 350 | |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 351 | #ifdef DEBUG |
| 352 | print_packet(uip_buf, uip_len); |
| 353 | #endif |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 354 | |
oliverschmidt | 4affe76 | 2005-02-23 22:43:00 +0000 | [diff] [blame] | 355 | /* Send 14+40=54 bytes of header */ |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 356 | |
oliverschmidt | 4affe76 | 2005-02-23 22:43:00 +0000 | [diff] [blame] | 357 | if(uip_len <= UIP_LLH_LEN + UIP_TCPIP_HLEN) { |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 358 | |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 359 | #ifdef DEBUG |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 360 | printf("SND: short packet sent.\n"); |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 361 | #endif |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 362 | |
oliverschmidt | 6b786ba | 2005-03-10 00:53:07 +0000 | [diff] [blame^] | 363 | asm("ldx %v", uip_len); |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 364 | asm("ldy #0"); |
oliverschmidt | 6b786ba | 2005-03-10 00:53:07 +0000 | [diff] [blame^] | 365 | WL1: |
| 366 | asm("lda %v,y", uip_buf); |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 367 | asm("sta %w", ETHDATA); |
| 368 | asm("iny"); |
| 369 | asm("dex"); |
oliverschmidt | 6b786ba | 2005-03-10 00:53:07 +0000 | [diff] [blame^] | 370 | asm("bne %g", WL1); |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 371 | |
| 372 | } else { |
| 373 | |
oliverschmidt | 4affe76 | 2005-02-23 22:43:00 +0000 | [diff] [blame] | 374 | asm("ldx #%b", UIP_LLH_LEN + UIP_TCPIP_HLEN); |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 375 | asm("ldy #0"); |
oliverschmidt | 6b786ba | 2005-03-10 00:53:07 +0000 | [diff] [blame^] | 376 | WL2: |
| 377 | asm("lda %v,y", uip_buf); |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 378 | asm("sta %w", ETHDATA); |
| 379 | asm("iny"); |
| 380 | asm("dex"); |
oliverschmidt | 6b786ba | 2005-03-10 00:53:07 +0000 | [diff] [blame^] | 381 | asm("bne %g", WL2); |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 382 | |
oliverschmidt | 4affe76 | 2005-02-23 22:43:00 +0000 | [diff] [blame] | 383 | uip_len -= UIP_LLH_LEN + UIP_TCPIP_HLEN; |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 384 | |
oliverschmidt | 6b786ba | 2005-03-10 00:53:07 +0000 | [diff] [blame^] | 385 | asm("lda %v", uip_appdata); /* uip_appdata is pointer */ |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 386 | asm("sta ptr1"); |
oliverschmidt | 6b786ba | 2005-03-10 00:53:07 +0000 | [diff] [blame^] | 387 | asm("lda %v+1", uip_appdata); |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 388 | asm("sta ptr1+1"); |
| 389 | |
| 390 | asm("ldy #0"); |
oliverschmidt | 6b786ba | 2005-03-10 00:53:07 +0000 | [diff] [blame^] | 391 | asm("ldx %v+1", uip_len); |
| 392 | asm("beq %g", RE1); /* packet_length < 256 */ |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 393 | |
oliverschmidt | 6b786ba | 2005-03-10 00:53:07 +0000 | [diff] [blame^] | 394 | RL1: |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 395 | asm("lda (ptr1),y"); |
| 396 | asm("sta %w", ETHDATA); |
| 397 | asm("iny"); |
oliverschmidt | 6b786ba | 2005-03-10 00:53:07 +0000 | [diff] [blame^] | 398 | asm("bne %g", RL1); |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 399 | asm("inc ptr1+1"); |
| 400 | asm("dex"); |
oliverschmidt | 6b786ba | 2005-03-10 00:53:07 +0000 | [diff] [blame^] | 401 | asm("bne %g", RL1); |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 402 | |
oliverschmidt | 6b786ba | 2005-03-10 00:53:07 +0000 | [diff] [blame^] | 403 | RE1: |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 404 | asm("lda (ptr1),y"); |
| 405 | asm("sta %w", ETHDATA); |
| 406 | asm("iny"); |
oliverschmidt | 6b786ba | 2005-03-10 00:53:07 +0000 | [diff] [blame^] | 407 | asm("cpy %v", uip_len); |
| 408 | asm("bne %g", RE1); |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 409 | |
| 410 | } |
| 411 | |
oliverschmidt | 6b786ba | 2005-03-10 00:53:07 +0000 | [diff] [blame^] | 412 | asm("lda %v", uip_len); |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 413 | asm("and #$01"); |
oliverschmidt | 6b786ba | 2005-03-10 00:53:07 +0000 | [diff] [blame^] | 414 | asm("beq %g", R3); |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 415 | |
| 416 | asm("lda #%%00100000"); |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 417 | asm("sta %w", ETHDATA); /* Control byte */ |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 418 | |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 419 | asm("lda #%%11000000"); /* ENQUEUE PACKET - transmit packet */ |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 420 | asm("sta %w", ETHMMUCR); |
| 421 | |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 422 | #ifdef DEBUG |
| 423 | printf("\n## %02x", *(unsigned char *)(ETHIST)); |
| 424 | #endif |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 425 | |
| 426 | return; |
| 427 | |
oliverschmidt | 6b786ba | 2005-03-10 00:53:07 +0000 | [diff] [blame^] | 428 | R3: |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 429 | |
| 430 | asm("lda #0"); |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 431 | asm("sta %w", ETHDATA); /* Fill byte */ |
| 432 | asm("sta %w", ETHDATA); /* Control byte */ |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 433 | |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 434 | asm("lda #%%11000000"); /* ENQUEUE PACKET - transmit packet */ |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 435 | asm("sta %w", ETHMMUCR); |
| 436 | |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 437 | #ifdef DEBUG |
| 438 | printf("\n## %02x\n", *(unsigned char *)(ETHIST)); |
| 439 | #endif |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 440 | return; |
| 441 | } |
oliverschmidt | a8240ea | 2004-07-18 13:19:47 +0000 | [diff] [blame] | 442 | #pragma optimize(pop) |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 443 | /*-----------------------------------------------------------------------------------*/ |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 444 | #ifdef DEBUG |
| 445 | static void print_packet(u8_t *buf, u16_t length) |
| 446 | { |
| 447 | int i; |
| 448 | int remainder; |
| 449 | int lines; |
| 450 | u8_t a; |
| 451 | int cur; |
| 452 | int address=0; |
| 453 | |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 454 | printf("\nPacket of length %d \n", length); |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 455 | |
| 456 | lines = length / 8; |
| 457 | remainder = length % 8; |
| 458 | |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 459 | for(i = 0; i < lines; i++) { |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 460 | printf(":%04x ", address=i*8); |
| 461 | |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 462 | for(cur = 0; cur < 8; cur++) { |
| 463 | a = *(buf++); |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 464 | printf("%02x ", a); |
| 465 | } |
| 466 | printf("\n"); |
| 467 | } |
| 468 | |
| 469 | printf(":%04x ", address+8); |
| 470 | |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 471 | for (i = 0; i < remainder; i++) { |
| 472 | a = *(buf++); |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 473 | printf("%02x ", a); |
| 474 | } |
| 475 | printf("\n"); |
| 476 | } |
| 477 | #endif /* DEBUG */ |