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 | 83b8327 | 2005-03-29 23:14:39 +0000 | [diff] [blame] | 35 | * $Id: lan91c96.c,v 1.13 2005/03/29 23:14:39 oliverschmidt Exp $ |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 36 | * |
| 37 | */ |
| 38 | |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 39 | #include "lan91c96.h" |
| 40 | #include "uip.h" |
| 41 | #include "uip_arp.h" |
| 42 | |
| 43 | #include <stdio.h> |
| 44 | |
| 45 | // #define DEBUG |
| 46 | |
| 47 | #define ETHBASE 0xde10 |
| 48 | |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 49 | #define ETHBSR ETHBASE+0x0e /* Bank select register R/W (2B) */ |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 50 | |
| 51 | /* Register bank 0 */ |
| 52 | |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 53 | #define ETHTCR ETHBASE /* Transmition control register R/W (2B) */ |
| 54 | #define ETHEPHSR ETHBASE+2 /* EPH status register R/O (2B) */ |
| 55 | #define ETHRCR ETHBASE+4 /* Receive control register R/W (2B) */ |
| 56 | #define ETHECR ETHBASE+6 /* Counter register R/O (2B) */ |
| 57 | #define ETHMIR ETHBASE+8 /* Memory information register R/O (2B) */ |
| 58 | #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] | 59 | |
| 60 | /* Register bank 1 */ |
| 61 | |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 62 | #define ETHCR ETHBASE /* Configuration register R/W (2B) */ |
| 63 | #define ETHBAR ETHBASE+2 /* Base address register R/W (2B) */ |
| 64 | #define ETHIAR ETHBASE+4 /* Individual address register R/W (6B) */ |
| 65 | #define ETHGPR ETHBASE+0x0a /* General address register R/W (2B) */ |
| 66 | #define ETHCTR ETHBASE+0x0c /* Control register R/W (2B) */ |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 67 | |
| 68 | /* Register bank 2 */ |
| 69 | |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 70 | #define ETHMMUCR ETHBASE /* MMU command register W/O (1B) */ |
| 71 | #define ETHAUTOTX ETHBASE+1 /* AUTO TX start register R/W (1B) */ |
| 72 | #define ETHPNR ETHBASE+2 /* Packet number register R/W (1B) */ |
| 73 | #define ETHARR ETHBASE+3 /* Allocation result register R/O (1B) */ |
| 74 | #define ETHFIFO ETHBASE+4 /* FIFO ports register R/O (2B) */ |
| 75 | #define ETHPTR ETHBASE+6 /* Pointer register R/W (2B) */ |
| 76 | #define ETHDATA ETHBASE+8 /* Data register R/W (4B) */ |
| 77 | #define ETHIST ETHBASE+0x0c /* Interrupt status register R/O (1B) */ |
| 78 | #define ETHACK ETHBASE+0x0c /* Interrupt acknowledge register W/O (1B) */ |
| 79 | #define ETHMSK ETHBASE+0x0d /* Interrupt mask register R/W (1B) */ |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 80 | |
| 81 | /* Register bank 3 */ |
| 82 | |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 83 | #define ETHMT ETHBASE /* Multicast table R/W (8B) */ |
| 84 | #define ETHMGMT ETHBASE+8 /* Management interface R/W (2B) */ |
| 85 | #define ETHREV ETHBASE+0x0a /* Revision register R/W (2B) */ |
| 86 | #define ETHERCV ETHBASE+0x0c /* Early RCV register R/W (2B) */ |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 87 | |
oliverschmidt | ff8cd80 | 2005-03-13 21:21:15 +0000 | [diff] [blame] | 88 | #define BANK(num) asm("lda #%b", num); asm("sta %w", ETHBSR); |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 89 | |
| 90 | #ifdef DEBUG |
| 91 | static void print_packet(u8_t *, u16_t); |
| 92 | #endif |
| 93 | |
| 94 | static u8_t packet_status; |
| 95 | static u16_t packet_length; |
| 96 | |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 97 | |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 98 | /*-----------------------------------------------------------------------------------*/ |
oliverschmidt | a8240ea | 2004-07-18 13:19:47 +0000 | [diff] [blame] | 99 | #pragma optimize(push, off) |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 100 | void lan91c96_init(void) |
| 101 | { |
| 102 | /* Check if high byte is 0x33 */ |
| 103 | asm("lda %w", ETHBSR+1); |
| 104 | asm("cmp #$33"); |
oliverschmidt | 6b786ba | 2005-03-10 00:53:07 +0000 | [diff] [blame] | 105 | asm("beq %g", L1); |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 106 | |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 107 | asm("inc $d021"); /* Error */ |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 108 | |
oliverschmidt | 6b786ba | 2005-03-10 00:53:07 +0000 | [diff] [blame] | 109 | L1: |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 110 | /* Reset ETH card */ |
| 111 | BANK(0); |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 112 | asm("lda #%%10000000"); /* Software reset */ |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 113 | asm("sta %w", ETHRCR+1); |
| 114 | |
| 115 | asm("lda #0"); |
| 116 | asm("sta %w", ETHRCR); |
| 117 | asm("sta %w", ETHRCR+1); |
| 118 | |
| 119 | /* delay */ |
oliverschmidt | ff8cd80 | 2005-03-13 21:21:15 +0000 | [diff] [blame] | 120 | asm("ldy #0"); |
oliverschmidt | 6b786ba | 2005-03-10 00:53:07 +0000 | [diff] [blame] | 121 | L2: |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 122 | asm("cmp ($ff,x)"); /* 6 cycles */ |
| 123 | asm("cmp ($ff,x)"); /* 6 cycles */ |
oliverschmidt | ff8cd80 | 2005-03-13 21:21:15 +0000 | [diff] [blame] | 124 | asm("dey"); /* 2 cycles */ |
oliverschmidt | 6b786ba | 2005-03-10 00:53:07 +0000 | [diff] [blame] | 125 | asm("bne %g", L2); /* 3 cycles */ |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 126 | /* 17*256=4352 => 4,4 ms */ |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 127 | |
| 128 | /* Enable transmit and receive */ |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 129 | asm("lda #%%10000001"); /* Enable transmit TXENA, PAD_EN */ |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 130 | asm("sta %w", ETHTCR); |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 131 | asm("lda #%%00000011"); /* Enable receive, strip CRC ??? */ |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 132 | asm("sta %w", ETHRCR+1); |
| 133 | |
| 134 | BANK(1); |
| 135 | asm("lda %w", ETHCR+1); |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 136 | asm("ora #%%00010000"); /* No wait (IOCHRDY) */ |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 137 | asm("sta %w", ETHCR+1); |
| 138 | |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 139 | asm("lda #%%00001001"); /* Auto release */ |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 140 | asm("sta %w", ETHCTR+1); |
| 141 | |
| 142 | /* Set MAC address */ |
oliverschmidt | e245c9c | 2005-03-14 23:01:36 +0000 | [diff] [blame] | 143 | asm("lda %v", uip_ethaddr); |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 144 | asm("sta %w", ETHIAR); |
oliverschmidt | e245c9c | 2005-03-14 23:01:36 +0000 | [diff] [blame] | 145 | asm("lda %v+1", uip_ethaddr); |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 146 | asm("sta %w", ETHIAR+1); |
oliverschmidt | e245c9c | 2005-03-14 23:01:36 +0000 | [diff] [blame] | 147 | asm("lda %v+2", uip_ethaddr); |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 148 | asm("sta %w", ETHIAR+2); |
oliverschmidt | e245c9c | 2005-03-14 23:01:36 +0000 | [diff] [blame] | 149 | asm("lda %v+3", uip_ethaddr); |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 150 | asm("sta %w", ETHIAR+3); |
oliverschmidt | e245c9c | 2005-03-14 23:01:36 +0000 | [diff] [blame] | 151 | asm("lda %v+4", uip_ethaddr); |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 152 | asm("sta %w", ETHIAR+4); |
oliverschmidt | e245c9c | 2005-03-14 23:01:36 +0000 | [diff] [blame] | 153 | asm("lda %v+5", uip_ethaddr); |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 154 | asm("sta %w", ETHIAR+5); |
| 155 | |
| 156 | BANK(2); |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 157 | asm("lda #%%00001111"); /* RCV INT, ALLOC INT, TX INT, TX EMPTY */ |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 158 | asm("sta %w", ETHMSK); |
| 159 | } |
oliverschmidt | a8240ea | 2004-07-18 13:19:47 +0000 | [diff] [blame] | 160 | #pragma optimize(pop) |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 161 | /*-----------------------------------------------------------------------------------*/ |
oliverschmidt | a8240ea | 2004-07-18 13:19:47 +0000 | [diff] [blame] | 162 | #pragma optimize(push, off) |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 163 | u16_t lan91c96_poll(void) |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 164 | { |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 165 | #ifdef DEBUG |
| 166 | BANK(0); |
| 167 | printf("RAM: %d ", ((*(unsigned int *)(ETHMIR)) & 0xff00)); |
| 168 | BANK(2); |
| 169 | #endif |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 170 | |
| 171 | asm("lda %w", ETHIST); |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 172 | asm("and #%%00000001"); /* RCV INT */ |
oliverschmidt | 6b786ba | 2005-03-10 00:53:07 +0000 | [diff] [blame] | 173 | asm("bne %g", L1); |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 174 | |
| 175 | /* No packet available */ |
| 176 | return 0; |
| 177 | |
oliverschmidt | 6b786ba | 2005-03-10 00:53:07 +0000 | [diff] [blame] | 178 | L1: |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 179 | |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 180 | #ifdef DEBUG |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 181 | printf("RCV: IRQ\n"); |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 182 | #endif |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 183 | |
| 184 | asm("lda #0"); |
| 185 | asm("sta %w", ETHPTR); |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 186 | asm("lda #%%11100000"); /* RCV,AUTO INCR.,READ */ |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 187 | asm("sta %w", ETHPTR+1); |
| 188 | |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 189 | asm("lda %w", ETHDATA); /* Status word */ |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 190 | asm("lda %w", ETHDATA); |
oliverschmidt | 6b786ba | 2005-03-10 00:53:07 +0000 | [diff] [blame] | 191 | asm("sta %v", packet_status); /* High byte only */ |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 192 | |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 193 | asm("lda %w", ETHDATA); /* Total number of bytes */ |
oliverschmidt | 6b786ba | 2005-03-10 00:53:07 +0000 | [diff] [blame] | 194 | asm("sta %v", packet_length); |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 195 | asm("lda %w", ETHDATA); |
oliverschmidt | 6b786ba | 2005-03-10 00:53:07 +0000 | [diff] [blame] | 196 | asm("sta %v+1", packet_length); |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 197 | |
| 198 | /* Last word contain 'last data byte' and 0x60 */ |
| 199 | /* or 'fill byte' and 0x40 */ |
| 200 | |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 201 | packet_length -= 6; /* The packet contains 3 extra words */ |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 202 | |
oliverschmidt | 6b786ba | 2005-03-10 00:53:07 +0000 | [diff] [blame] | 203 | asm("lda %v", packet_status); |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 204 | asm("and #$10"); |
oliverschmidt | 6b786ba | 2005-03-10 00:53:07 +0000 | [diff] [blame] | 205 | asm("beq %g", L2); |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 206 | |
| 207 | packet_length++; |
| 208 | |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 209 | #ifdef DEBUG |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 210 | printf("RCV: odd number of bytes\n"); |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 211 | #endif |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 212 | |
oliverschmidt | 6b786ba | 2005-03-10 00:53:07 +0000 | [diff] [blame] | 213 | L2: |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 214 | |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 215 | #ifdef DEBUG |
oliverschmidt | 6b786ba | 2005-03-10 00:53:07 +0000 | [diff] [blame] | 216 | printf("RCV: L:%d ST-HIGH:0x%02x ", packet_length, packet_status); |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 217 | #endif |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 218 | |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 219 | if(packet_length > UIP_BUFSIZE) { |
| 220 | |
| 221 | /* Remove and release RX packet from FIFO */ |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 222 | asm("lda #%%10000000"); |
| 223 | asm("sta %w", ETHMMUCR); |
| 224 | |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 225 | #ifdef DEBUG |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 226 | printf("RCV: UIP_BUFSIZE exceeded - packet dropped!\n"); |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 227 | #endif |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 228 | |
| 229 | return 0; |
| 230 | } |
| 231 | |
oliverschmidt | 6b786ba | 2005-03-10 00:53:07 +0000 | [diff] [blame] | 232 | asm("lda #<%v", uip_buf); |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 233 | asm("sta ptr1"); |
oliverschmidt | 6b786ba | 2005-03-10 00:53:07 +0000 | [diff] [blame] | 234 | asm("lda #>%v", uip_buf); |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 235 | asm("sta ptr1+1"); |
| 236 | |
oliverschmidt | ff8cd80 | 2005-03-13 21:21:15 +0000 | [diff] [blame] | 237 | asm("lda %v+1", packet_length); |
| 238 | asm("sta tmp1"); |
| 239 | |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 240 | asm("ldy #0"); |
oliverschmidt | ff8cd80 | 2005-03-13 21:21:15 +0000 | [diff] [blame] | 241 | L3: |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 242 | asm("lda %w", ETHDATA); |
| 243 | asm("sta (ptr1),y"); |
| 244 | asm("iny"); |
oliverschmidt | ff8cd80 | 2005-03-13 21:21:15 +0000 | [diff] [blame] | 245 | asm("bne %g", L4); |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 246 | asm("inc ptr1+1"); |
oliverschmidt | ff8cd80 | 2005-03-13 21:21:15 +0000 | [diff] [blame] | 247 | L4: |
oliverschmidt | 6b786ba | 2005-03-10 00:53:07 +0000 | [diff] [blame] | 248 | asm("cpy %v", packet_length); |
oliverschmidt | ff8cd80 | 2005-03-13 21:21:15 +0000 | [diff] [blame] | 249 | asm("bne %g", L3); |
| 250 | asm("dec tmp1"); |
| 251 | asm("bpl %g", L3); |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 252 | |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 253 | /* Remove and release RX packet from FIFO */ |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 254 | asm("lda #%%10000000"); |
| 255 | asm("sta %w", ETHMMUCR); |
| 256 | |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 257 | #ifdef DEBUG |
| 258 | print_packet(uip_buf, packet_length); |
| 259 | #endif |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 260 | |
| 261 | return packet_length; |
| 262 | } |
oliverschmidt | a8240ea | 2004-07-18 13:19:47 +0000 | [diff] [blame] | 263 | #pragma optimize(pop) |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 264 | /*-----------------------------------------------------------------------------------*/ |
oliverschmidt | a8240ea | 2004-07-18 13:19:47 +0000 | [diff] [blame] | 265 | #pragma optimize(push, off) |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 266 | void lan91c96_send(void) |
| 267 | { |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 268 | /* First 14+40 (IP and TCP header) is send from uip_buf */ |
| 269 | /* than data from uip_appdata */ |
| 270 | |
| 271 | #ifdef DEBUG |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 272 | printf("SND: send packet\n"); |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 273 | #endif |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 274 | |
oliverschmidt | 6b786ba | 2005-03-10 00:53:07 +0000 | [diff] [blame] | 275 | asm("lda %v+1", uip_len); |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 276 | asm("ora #%%00100000"); /* Allocate memory for TX */ |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 277 | asm("sta %w", ETHMMUCR); |
| 278 | |
oliverschmidt | ff8cd80 | 2005-03-13 21:21:15 +0000 | [diff] [blame] | 279 | asm("ldy #8"); /* Wait... */ |
oliverschmidt | 6b786ba | 2005-03-10 00:53:07 +0000 | [diff] [blame] | 280 | L1: /* Wait for allocation ready */ |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 281 | asm("lda %w", ETHIST); |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 282 | asm("and #%%00001000"); /* ALLOC INT */ |
oliverschmidt | ff8cd80 | 2005-03-13 21:21:15 +0000 | [diff] [blame] | 283 | asm("bne %g", L2); |
| 284 | asm("dey"); |
oliverschmidt | 6b786ba | 2005-03-10 00:53:07 +0000 | [diff] [blame] | 285 | asm("bne %g", L1); |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 286 | |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 287 | #ifdef DEBUG |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 288 | printf("SND: ERR: memory alloc timeout\n"); |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 289 | #endif |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 290 | |
| 291 | return; |
| 292 | |
oliverschmidt | ff8cd80 | 2005-03-13 21:21:15 +0000 | [diff] [blame] | 293 | L2: |
| 294 | |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 295 | #ifdef DEBUG |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 296 | printf("SND: packet memory allocated\n"); |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 297 | #endif |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 298 | |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 299 | asm("lda #%%00001000"); /* Acknowledge int, is it necessary ??? */ |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 300 | asm("sta %w", ETHACK); |
| 301 | |
| 302 | asm("lda %w", ETHARR); |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 303 | asm("sta %w", ETHPNR); /* Set packet address */ |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 304 | |
| 305 | asm("lda #0"); |
| 306 | asm("sta %w", ETHPTR); |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 307 | asm("lda #%%01000000"); /* AUTO INCR. */ |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 308 | asm("sta %w", ETHPTR+1); |
| 309 | |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 310 | #ifdef DEBUG |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 311 | printf("SND: L:%d ", uip_len); |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 312 | #endif |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 313 | |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 314 | asm("lda #0"); /* Status written by CSMA */ |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 315 | asm("sta %w", ETHDATA); |
| 316 | asm("sta %w", ETHDATA); |
| 317 | |
oliverschmidt | 6b786ba | 2005-03-10 00:53:07 +0000 | [diff] [blame] | 318 | asm("lda %v", uip_len); |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 319 | asm("and #$01"); |
oliverschmidt | ff8cd80 | 2005-03-13 21:21:15 +0000 | [diff] [blame] | 320 | asm("beq %g", L3); |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 321 | |
oliverschmidt | 6b786ba | 2005-03-10 00:53:07 +0000 | [diff] [blame] | 322 | packet_length = uip_len + 5; |
oliverschmidt | ff8cd80 | 2005-03-13 21:21:15 +0000 | [diff] [blame] | 323 | asm("jmp %g", L4); |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 324 | |
oliverschmidt | ff8cd80 | 2005-03-13 21:21:15 +0000 | [diff] [blame] | 325 | L3: |
oliverschmidt | 6b786ba | 2005-03-10 00:53:07 +0000 | [diff] [blame] | 326 | packet_length = uip_len + 6; /* +6 for status word, length and ctl byte */ |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 327 | |
oliverschmidt | ff8cd80 | 2005-03-13 21:21:15 +0000 | [diff] [blame] | 328 | L4: |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 329 | |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 330 | #ifdef DEBUG |
| 331 | printf("SND: L:%d ", packet_length); |
| 332 | #endif |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 333 | |
oliverschmidt | 6b786ba | 2005-03-10 00:53:07 +0000 | [diff] [blame] | 334 | asm("lda %v", packet_length); |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 335 | asm("sta %w", ETHDATA); |
oliverschmidt | 6b786ba | 2005-03-10 00:53:07 +0000 | [diff] [blame] | 336 | asm("lda %v+1", packet_length); |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 337 | asm("sta %w", ETHDATA); |
| 338 | |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 339 | #ifdef DEBUG |
| 340 | print_packet(uip_buf, uip_len); |
| 341 | #endif |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 342 | |
oliverschmidt | 4affe76 | 2005-02-23 22:43:00 +0000 | [diff] [blame] | 343 | /* Send 14+40=54 bytes of header */ |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 344 | |
oliverschmidt | 4affe76 | 2005-02-23 22:43:00 +0000 | [diff] [blame] | 345 | if(uip_len <= UIP_LLH_LEN + UIP_TCPIP_HLEN) { |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 346 | |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 347 | #ifdef DEBUG |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 348 | printf("SND: short packet sent.\n"); |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 349 | #endif |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 350 | |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 351 | asm("ldy #0"); |
oliverschmidt | ff8cd80 | 2005-03-13 21:21:15 +0000 | [diff] [blame] | 352 | L5: |
oliverschmidt | 6b786ba | 2005-03-10 00:53:07 +0000 | [diff] [blame] | 353 | asm("lda %v,y", uip_buf); |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 354 | asm("sta %w", ETHDATA); |
| 355 | asm("iny"); |
oliverschmidt | ff8cd80 | 2005-03-13 21:21:15 +0000 | [diff] [blame] | 356 | asm("cpy %v", uip_len); |
| 357 | asm("bne %g", L5); |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 358 | |
| 359 | } else { |
| 360 | |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 361 | asm("ldy #0"); |
oliverschmidt | ff8cd80 | 2005-03-13 21:21:15 +0000 | [diff] [blame] | 362 | L6: |
oliverschmidt | 6b786ba | 2005-03-10 00:53:07 +0000 | [diff] [blame] | 363 | asm("lda %v,y", uip_buf); |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 364 | asm("sta %w", ETHDATA); |
| 365 | asm("iny"); |
oliverschmidt | ff8cd80 | 2005-03-13 21:21:15 +0000 | [diff] [blame] | 366 | asm("cpy #%b", UIP_LLH_LEN + UIP_TCPIP_HLEN); |
| 367 | asm("bne %g", L6); |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 368 | |
oliverschmidt | c8bfc02 | 2005-03-16 22:39:21 +0000 | [diff] [blame] | 369 | packet_length = uip_len - (UIP_LLH_LEN + UIP_TCPIP_HLEN); |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 370 | |
oliverschmidt | 6b786ba | 2005-03-10 00:53:07 +0000 | [diff] [blame] | 371 | asm("lda %v", uip_appdata); /* uip_appdata is pointer */ |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 372 | asm("sta ptr1"); |
oliverschmidt | 6b786ba | 2005-03-10 00:53:07 +0000 | [diff] [blame] | 373 | asm("lda %v+1", uip_appdata); |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 374 | asm("sta ptr1+1"); |
| 375 | |
| 376 | asm("ldy #0"); |
oliverschmidt | ff8cd80 | 2005-03-13 21:21:15 +0000 | [diff] [blame] | 377 | L7: |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 378 | asm("lda (ptr1),y"); |
| 379 | asm("sta %w", ETHDATA); |
| 380 | asm("iny"); |
oliverschmidt | ff8cd80 | 2005-03-13 21:21:15 +0000 | [diff] [blame] | 381 | asm("bne %g", L8); |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 382 | asm("inc ptr1+1"); |
oliverschmidt | ff8cd80 | 2005-03-13 21:21:15 +0000 | [diff] [blame] | 383 | L8: |
| 384 | asm("cpy %v", packet_length); |
| 385 | asm("bne %g", L7); |
| 386 | asm("dec %v+1", packet_length); |
| 387 | asm("bpl %g", L7); |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 388 | } |
| 389 | |
oliverschmidt | ff8cd80 | 2005-03-13 21:21:15 +0000 | [diff] [blame] | 390 | asm("lda %v", packet_length); |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 391 | asm("and #$01"); |
oliverschmidt | ff8cd80 | 2005-03-13 21:21:15 +0000 | [diff] [blame] | 392 | asm("beq %g", L9); |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 393 | |
| 394 | asm("lda #%%00100000"); |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 395 | asm("sta %w", ETHDATA); /* Control byte */ |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 396 | |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 397 | asm("lda #%%11000000"); /* ENQUEUE PACKET - transmit packet */ |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 398 | asm("sta %w", ETHMMUCR); |
| 399 | |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 400 | #ifdef DEBUG |
| 401 | printf("\n## %02x", *(unsigned char *)(ETHIST)); |
| 402 | #endif |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 403 | |
| 404 | return; |
| 405 | |
oliverschmidt | ff8cd80 | 2005-03-13 21:21:15 +0000 | [diff] [blame] | 406 | L9: |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 407 | asm("lda #0"); |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 408 | asm("sta %w", ETHDATA); /* Fill byte */ |
| 409 | asm("sta %w", ETHDATA); /* Control byte */ |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 410 | |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 411 | asm("lda #%%11000000"); /* ENQUEUE PACKET - transmit packet */ |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 412 | asm("sta %w", ETHMMUCR); |
| 413 | |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 414 | #ifdef DEBUG |
| 415 | printf("\n## %02x\n", *(unsigned char *)(ETHIST)); |
| 416 | #endif |
oliverschmidt | 83b8327 | 2005-03-29 23:14:39 +0000 | [diff] [blame] | 417 | |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 418 | } |
oliverschmidt | a8240ea | 2004-07-18 13:19:47 +0000 | [diff] [blame] | 419 | #pragma optimize(pop) |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 420 | /*-----------------------------------------------------------------------------------*/ |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 421 | #ifdef DEBUG |
| 422 | static void print_packet(u8_t *buf, u16_t length) |
| 423 | { |
| 424 | int i; |
| 425 | int remainder; |
| 426 | int lines; |
| 427 | u8_t a; |
| 428 | int cur; |
| 429 | int address=0; |
| 430 | |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 431 | printf("\nPacket of length %d \n", length); |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 432 | |
| 433 | lines = length / 8; |
| 434 | remainder = length % 8; |
| 435 | |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 436 | for(i = 0; i < lines; i++) { |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 437 | printf(":%04x ", address=i*8); |
| 438 | |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 439 | for(cur = 0; cur < 8; cur++) { |
| 440 | a = *(buf++); |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 441 | printf("%02x ", a); |
| 442 | } |
| 443 | printf("\n"); |
| 444 | } |
| 445 | |
| 446 | printf(":%04x ", address+8); |
| 447 | |
oliverschmidt | 3c3aed4 | 2005-03-10 00:05:46 +0000 | [diff] [blame] | 448 | for (i = 0; i < remainder; i++) { |
| 449 | a = *(buf++); |
adamdunkels | 45c1f13 | 2004-02-16 20:59:49 +0000 | [diff] [blame] | 450 | printf("%02x ", a); |
| 451 | } |
| 452 | printf("\n"); |
| 453 | } |
| 454 | #endif /* DEBUG */ |