oliverschmidt | d36173a | 2005-01-22 02:56:00 +0000 | [diff] [blame] | 1 | /* |
| 2 | * Copyright (c) 2001, Adam Dunkels. |
| 3 | * All rights reserved. |
| 4 | * |
| 5 | * Redistribution and use in source and binary forms, with or without |
| 6 | * modification, are permitted provided that the following conditions |
| 7 | * are met: |
| 8 | * 1. Redistributions of source code must retain the above copyright |
| 9 | * notice, this list of conditions and the following disclaimer. |
| 10 | * 2. Redistributions in binary form must reproduce the above copyright |
| 11 | * notice, this list of conditions and the following disclaimer in the |
| 12 | * documentation and/or other materials provided with the distribution. |
| 13 | * 3. The name of the author may not be used to endorse or promote |
| 14 | * products derived from this software without specific prior |
| 15 | * written permission. |
| 16 | * |
| 17 | * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS |
| 18 | * OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED |
| 19 | * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE |
| 20 | * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY |
| 21 | * DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL |
| 22 | * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE |
| 23 | * GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS |
| 24 | * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, |
| 25 | * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING |
| 26 | * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS |
| 27 | * SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. |
| 28 | * |
| 29 | * This file is part of the C64 RealAudio server demo project. |
| 30 | * |
oliverschmidt | 356f366 | 2005-05-22 14:04:00 +0000 | [diff] [blame] | 31 | * $Id: cs8900a.c,v 1.8 2005/05/22 14:04:21 oliverschmidt Exp $ |
oliverschmidt | d36173a | 2005-01-22 02:56:00 +0000 | [diff] [blame] | 32 | * |
| 33 | */ |
| 34 | |
| 35 | /* cs8900a.c: device driver for the CS8900a chip in 8-bit mode. Mostly |
| 36 | written in 6502 assembler for speed. */ |
| 37 | |
| 38 | #include "cs8900a.h" |
| 39 | #include "uip.h" |
| 40 | #include "uip_arp.h" |
| 41 | |
oliverschmidt | 2fa3323 | 2005-01-26 21:33:29 +0000 | [diff] [blame] | 42 | extern u8_t lanslot; |
oliverschmidt | d36173a | 2005-01-22 02:56:00 +0000 | [diff] [blame] | 43 | extern u8_t *cs8900a_rxtxreg, |
oliverschmidt | 2fa3323 | 2005-01-26 21:33:29 +0000 | [diff] [blame] | 44 | *cs8900a_txcmd, |
| 45 | *cs8900a_txlen, |
| 46 | *cs8900a_packetpp, |
| 47 | *cs8900a_ppdata; |
oliverschmidt | d36173a | 2005-01-22 02:56:00 +0000 | [diff] [blame] | 48 | |
oliverschmidt | 2fa3323 | 2005-01-26 21:33:29 +0000 | [diff] [blame] | 49 | static u8_t idx; |
oliverschmidt | d36173a | 2005-01-22 02:56:00 +0000 | [diff] [blame] | 50 | static u16_t len; |
oliverschmidt | 2fa3323 | 2005-01-26 21:33:29 +0000 | [diff] [blame] | 51 | static u16_t cnt; |
oliverschmidt | d36173a | 2005-01-22 02:56:00 +0000 | [diff] [blame] | 52 | |
| 53 | |
| 54 | /*-----------------------------------------------------------------------------------*/ |
| 55 | #pragma optimize(push, off) |
| 56 | void |
| 57 | cs8900a_init(void) |
| 58 | { |
oliverschmidt | 2fa3323 | 2005-01-26 21:33:29 +0000 | [diff] [blame] | 59 | asm("lda %v", lanslot); |
oliverschmidt | 356f366 | 2005-05-22 14:04:00 +0000 | [diff] [blame] | 60 | asm("beq %g", bailout); |
oliverschmidt | 2fa3323 | 2005-01-26 21:33:29 +0000 | [diff] [blame] | 61 | asm("asl"); |
| 62 | asm("asl"); |
| 63 | asm("asl"); |
| 64 | asm("asl"); |
| 65 | asm("sta %v", idx); |
| 66 | asm("tax"); |
| 67 | |
oliverschmidt | d36173a | 2005-01-22 02:56:00 +0000 | [diff] [blame] | 68 | /* Turn on transmission and reception of frames. */ |
| 69 | /* PACKETPP = 0x0112; |
| 70 | PPDATA = 0x00c0; */ |
| 71 | asm("lda #$12"); |
oliverschmidt | 2fa3323 | 2005-01-26 21:33:29 +0000 | [diff] [blame] | 72 | asm("sta %v,x", cs8900a_packetpp); |
oliverschmidt | d36173a | 2005-01-22 02:56:00 +0000 | [diff] [blame] | 73 | asm("lda #$01"); |
oliverschmidt | 2fa3323 | 2005-01-26 21:33:29 +0000 | [diff] [blame] | 74 | asm("sta %v+1,x", cs8900a_packetpp); |
oliverschmidt | d36173a | 2005-01-22 02:56:00 +0000 | [diff] [blame] | 75 | asm("lda #$c0"); |
oliverschmidt | 2fa3323 | 2005-01-26 21:33:29 +0000 | [diff] [blame] | 76 | asm("sta %v,x", cs8900a_ppdata); |
oliverschmidt | d36173a | 2005-01-22 02:56:00 +0000 | [diff] [blame] | 77 | asm("lda #$00"); |
oliverschmidt | 2fa3323 | 2005-01-26 21:33:29 +0000 | [diff] [blame] | 78 | asm("sta %v+1,x", cs8900a_ppdata); |
oliverschmidt | d36173a | 2005-01-22 02:56:00 +0000 | [diff] [blame] | 79 | |
| 80 | /* Accept valid unicast+broadcast frames. */ |
| 81 | /* PACKETPP = 0x0104; |
| 82 | PPDATA = 0x0d05; */ |
| 83 | asm("lda #$04"); |
oliverschmidt | 2fa3323 | 2005-01-26 21:33:29 +0000 | [diff] [blame] | 84 | asm("sta %v,x", cs8900a_packetpp); |
oliverschmidt | d36173a | 2005-01-22 02:56:00 +0000 | [diff] [blame] | 85 | asm("lda #$01"); |
oliverschmidt | 2fa3323 | 2005-01-26 21:33:29 +0000 | [diff] [blame] | 86 | asm("sta %v+1,x", cs8900a_packetpp); |
oliverschmidt | d36173a | 2005-01-22 02:56:00 +0000 | [diff] [blame] | 87 | asm("lda #$05"); |
oliverschmidt | 2fa3323 | 2005-01-26 21:33:29 +0000 | [diff] [blame] | 88 | asm("sta %v,x", cs8900a_ppdata); |
oliverschmidt | d36173a | 2005-01-22 02:56:00 +0000 | [diff] [blame] | 89 | asm("lda #$0d"); |
oliverschmidt | 2fa3323 | 2005-01-26 21:33:29 +0000 | [diff] [blame] | 90 | asm("sta %v+1,x", cs8900a_ppdata); |
oliverschmidt | d36173a | 2005-01-22 02:56:00 +0000 | [diff] [blame] | 91 | |
| 92 | /* Set MAC address. */ |
| 93 | /* PACKETPP = 0x0158; |
| 94 | PPDATA = (ETHADDR1 << 8) | (ETHADDR0); */ |
| 95 | asm("lda #$58"); |
oliverschmidt | 2fa3323 | 2005-01-26 21:33:29 +0000 | [diff] [blame] | 96 | asm("sta %v,x", cs8900a_packetpp); |
oliverschmidt | d36173a | 2005-01-22 02:56:00 +0000 | [diff] [blame] | 97 | asm("lda #$01"); |
oliverschmidt | 2fa3323 | 2005-01-26 21:33:29 +0000 | [diff] [blame] | 98 | asm("sta %v+1,x", cs8900a_packetpp); |
oliverschmidt | d36173a | 2005-01-22 02:56:00 +0000 | [diff] [blame] | 99 | asm("lda %v", uip_ethaddr); |
oliverschmidt | 2fa3323 | 2005-01-26 21:33:29 +0000 | [diff] [blame] | 100 | asm("sta %v,x", cs8900a_ppdata); |
oliverschmidt | d36173a | 2005-01-22 02:56:00 +0000 | [diff] [blame] | 101 | asm("lda %v+1", uip_ethaddr); |
oliverschmidt | 2fa3323 | 2005-01-26 21:33:29 +0000 | [diff] [blame] | 102 | asm("sta %v+1,x", cs8900a_ppdata); |
oliverschmidt | d36173a | 2005-01-22 02:56:00 +0000 | [diff] [blame] | 103 | |
| 104 | /* PACKETPP = 0x015a; |
| 105 | PPDATA = (ETHADDR3 << 8) | (ETHADDR2); */ |
| 106 | asm("lda #$5a"); |
oliverschmidt | 2fa3323 | 2005-01-26 21:33:29 +0000 | [diff] [blame] | 107 | asm("sta %v,x", cs8900a_packetpp); |
oliverschmidt | d36173a | 2005-01-22 02:56:00 +0000 | [diff] [blame] | 108 | asm("lda #$01"); |
oliverschmidt | 2fa3323 | 2005-01-26 21:33:29 +0000 | [diff] [blame] | 109 | asm("sta %v+1,x", cs8900a_packetpp); |
oliverschmidt | d36173a | 2005-01-22 02:56:00 +0000 | [diff] [blame] | 110 | asm("lda %v+2", uip_ethaddr); |
oliverschmidt | 2fa3323 | 2005-01-26 21:33:29 +0000 | [diff] [blame] | 111 | asm("sta %v,x", cs8900a_ppdata); |
oliverschmidt | d36173a | 2005-01-22 02:56:00 +0000 | [diff] [blame] | 112 | asm("lda %v+3", uip_ethaddr); |
oliverschmidt | 2fa3323 | 2005-01-26 21:33:29 +0000 | [diff] [blame] | 113 | asm("sta %v+1,x", cs8900a_ppdata); |
oliverschmidt | d36173a | 2005-01-22 02:56:00 +0000 | [diff] [blame] | 114 | |
| 115 | /* PACKETPP = 0x015c; |
| 116 | PPDATA = (ETHADDR5 << 8) | (ETHADDR4); */ |
| 117 | asm("lda #$5c"); |
oliverschmidt | 2fa3323 | 2005-01-26 21:33:29 +0000 | [diff] [blame] | 118 | asm("sta %v,x", cs8900a_packetpp); |
oliverschmidt | d36173a | 2005-01-22 02:56:00 +0000 | [diff] [blame] | 119 | asm("lda #$01"); |
oliverschmidt | 2fa3323 | 2005-01-26 21:33:29 +0000 | [diff] [blame] | 120 | asm("sta %v+1,x", cs8900a_packetpp); |
oliverschmidt | d36173a | 2005-01-22 02:56:00 +0000 | [diff] [blame] | 121 | asm("lda %v+4", uip_ethaddr); |
oliverschmidt | 2fa3323 | 2005-01-26 21:33:29 +0000 | [diff] [blame] | 122 | asm("sta %v,x", cs8900a_ppdata); |
oliverschmidt | d36173a | 2005-01-22 02:56:00 +0000 | [diff] [blame] | 123 | asm("lda %v+5", uip_ethaddr); |
oliverschmidt | 2fa3323 | 2005-01-26 21:33:29 +0000 | [diff] [blame] | 124 | asm("sta %v+1,x", cs8900a_ppdata); |
oliverschmidt | 356f366 | 2005-05-22 14:04:00 +0000 | [diff] [blame] | 125 | bailout: |
oliverschmidt | d36173a | 2005-01-22 02:56:00 +0000 | [diff] [blame] | 126 | } |
| 127 | #pragma optimize(pop) |
| 128 | /*-----------------------------------------------------------------------------------*/ |
| 129 | #pragma optimize(push, off) |
| 130 | void |
| 131 | cs8900a_send(void) |
| 132 | { |
oliverschmidt | 2fa3323 | 2005-01-26 21:33:29 +0000 | [diff] [blame] | 133 | asm("ldx %v", idx); |
oliverschmidt | 356f366 | 2005-05-22 14:04:00 +0000 | [diff] [blame] | 134 | asm("beq %g", bailout); |
oliverschmidt | 2fa3323 | 2005-01-26 21:33:29 +0000 | [diff] [blame] | 135 | |
oliverschmidt | d36173a | 2005-01-22 02:56:00 +0000 | [diff] [blame] | 136 | /* Transmit command. */ |
| 137 | asm("lda #$c0"); |
oliverschmidt | 2fa3323 | 2005-01-26 21:33:29 +0000 | [diff] [blame] | 138 | asm("sta %v,x", cs8900a_txcmd); |
oliverschmidt | d36173a | 2005-01-22 02:56:00 +0000 | [diff] [blame] | 139 | asm("lda #$00"); |
oliverschmidt | 2fa3323 | 2005-01-26 21:33:29 +0000 | [diff] [blame] | 140 | asm("sta %v+1,x", cs8900a_txcmd); |
| 141 | asm("lda %v", uip_len); |
| 142 | asm("sta %v,x", cs8900a_txlen); |
| 143 | asm("lda %v+1", uip_len); |
| 144 | asm("sta %v+1,x", cs8900a_txlen); |
oliverschmidt | d36173a | 2005-01-22 02:56:00 +0000 | [diff] [blame] | 145 | |
oliverschmidt | 2fa3323 | 2005-01-26 21:33:29 +0000 | [diff] [blame] | 146 | asm("ldy #8"); |
oliverschmidt | ac66124 | 2005-03-09 23:31:23 +0000 | [diff] [blame] | 147 | tryagain: |
oliverschmidt | d36173a | 2005-01-22 02:56:00 +0000 | [diff] [blame] | 148 | /* Check for avaliable buffer space. */ |
| 149 | asm("lda #$38"); |
oliverschmidt | 2fa3323 | 2005-01-26 21:33:29 +0000 | [diff] [blame] | 150 | asm("sta %v,x", cs8900a_packetpp); |
oliverschmidt | d36173a | 2005-01-22 02:56:00 +0000 | [diff] [blame] | 151 | asm("lda #$01"); |
oliverschmidt | 2fa3323 | 2005-01-26 21:33:29 +0000 | [diff] [blame] | 152 | asm("sta %v+1,x", cs8900a_packetpp); |
| 153 | asm("lda %v+1,x", cs8900a_ppdata); |
oliverschmidt | d36173a | 2005-01-22 02:56:00 +0000 | [diff] [blame] | 154 | asm("and #1"); |
oliverschmidt | ac66124 | 2005-03-09 23:31:23 +0000 | [diff] [blame] | 155 | asm("bne %g", send); |
oliverschmidt | d36173a | 2005-01-22 02:56:00 +0000 | [diff] [blame] | 156 | |
| 157 | /* No space avaliable, skip a received frame and try again. */ |
| 158 | asm("lda #$02"); |
oliverschmidt | 2fa3323 | 2005-01-26 21:33:29 +0000 | [diff] [blame] | 159 | asm("sta %v,x", cs8900a_packetpp); |
oliverschmidt | d36173a | 2005-01-22 02:56:00 +0000 | [diff] [blame] | 160 | asm("lda #$01"); |
oliverschmidt | 2fa3323 | 2005-01-26 21:33:29 +0000 | [diff] [blame] | 161 | asm("sta %v+1,x", cs8900a_packetpp); |
| 162 | asm("lda %v,x", cs8900a_ppdata); |
oliverschmidt | d36173a | 2005-01-22 02:56:00 +0000 | [diff] [blame] | 163 | asm("ora #$40"); |
oliverschmidt | 2fa3323 | 2005-01-26 21:33:29 +0000 | [diff] [blame] | 164 | asm("sta %v,x", cs8900a_ppdata); |
oliverschmidt | d36173a | 2005-01-22 02:56:00 +0000 | [diff] [blame] | 165 | |
oliverschmidt | 2fa3323 | 2005-01-26 21:33:29 +0000 | [diff] [blame] | 166 | asm("dey"); |
oliverschmidt | ac66124 | 2005-03-09 23:31:23 +0000 | [diff] [blame] | 167 | asm("bne %g", tryagain); |
oliverschmidt | 356f366 | 2005-05-22 14:04:00 +0000 | [diff] [blame] | 168 | bailout: |
oliverschmidt | d36173a | 2005-01-22 02:56:00 +0000 | [diff] [blame] | 169 | return; |
| 170 | |
| 171 | /* Send the frame. */ |
oliverschmidt | ac66124 | 2005-03-09 23:31:23 +0000 | [diff] [blame] | 172 | send: |
oliverschmidt | d36173a | 2005-01-22 02:56:00 +0000 | [diff] [blame] | 173 | |
oliverschmidt | 3ff1aaa | 2005-02-23 22:41:30 +0000 | [diff] [blame] | 174 | /* First, send 14+40=54 bytes of header. */ |
oliverschmidt | d36173a | 2005-01-22 02:56:00 +0000 | [diff] [blame] | 175 | asm("ldy #0"); |
oliverschmidt | ac66124 | 2005-03-09 23:31:23 +0000 | [diff] [blame] | 176 | sendloop1: |
oliverschmidt | 2fa3323 | 2005-01-26 21:33:29 +0000 | [diff] [blame] | 177 | asm("lda %v,y", uip_buf); |
| 178 | asm("sta %v,x", cs8900a_rxtxreg); |
oliverschmidt | d36173a | 2005-01-22 02:56:00 +0000 | [diff] [blame] | 179 | asm("iny"); |
oliverschmidt | 2fa3323 | 2005-01-26 21:33:29 +0000 | [diff] [blame] | 180 | asm("lda %v,y", uip_buf); |
| 181 | asm("sta %v+1,x", cs8900a_rxtxreg); |
oliverschmidt | d36173a | 2005-01-22 02:56:00 +0000 | [diff] [blame] | 182 | asm("iny"); |
oliverschmidt | 3ff1aaa | 2005-02-23 22:41:30 +0000 | [diff] [blame] | 183 | asm("cpy #%b", UIP_LLH_LEN + UIP_TCPIP_HLEN); |
oliverschmidt | ac66124 | 2005-03-09 23:31:23 +0000 | [diff] [blame] | 184 | asm("bne %g", sendloop1); |
oliverschmidt | d36173a | 2005-01-22 02:56:00 +0000 | [diff] [blame] | 185 | |
oliverschmidt | 3ff1aaa | 2005-02-23 22:41:30 +0000 | [diff] [blame] | 186 | if(uip_len <= UIP_LLH_LEN + UIP_TCPIP_HLEN) { |
oliverschmidt | d36173a | 2005-01-22 02:56:00 +0000 | [diff] [blame] | 187 | return; |
| 188 | } |
| 189 | |
| 190 | /* Next, send rest of the packet. */ |
oliverschmidt | e2c0862 | 2005-03-16 22:38:54 +0000 | [diff] [blame] | 191 | cnt = uip_len - (UIP_LLH_LEN + UIP_TCPIP_HLEN); |
oliverschmidt | d36173a | 2005-01-22 02:56:00 +0000 | [diff] [blame] | 192 | |
oliverschmidt | 2fa3323 | 2005-01-26 21:33:29 +0000 | [diff] [blame] | 193 | asm("ldx %v", idx); |
| 194 | |
oliverschmidt | b65645c | 2005-03-13 21:15:26 +0000 | [diff] [blame] | 195 | asm("lda %v", cnt); |
oliverschmidt | 2fa3323 | 2005-01-26 21:33:29 +0000 | [diff] [blame] | 196 | asm("lsr"); |
oliverschmidt | ac66124 | 2005-03-09 23:31:23 +0000 | [diff] [blame] | 197 | asm("bcc %g", noinc); |
oliverschmidt | b65645c | 2005-03-13 21:15:26 +0000 | [diff] [blame] | 198 | asm("inc %v", cnt); |
oliverschmidt | ac66124 | 2005-03-09 23:31:23 +0000 | [diff] [blame] | 199 | asm("bne %g", noinc); |
oliverschmidt | b65645c | 2005-03-13 21:15:26 +0000 | [diff] [blame] | 200 | asm("inc %v+1", cnt); |
oliverschmidt | ac66124 | 2005-03-09 23:31:23 +0000 | [diff] [blame] | 201 | noinc: |
oliverschmidt | d36173a | 2005-01-22 02:56:00 +0000 | [diff] [blame] | 202 | |
oliverschmidt | 2fa3323 | 2005-01-26 21:33:29 +0000 | [diff] [blame] | 203 | asm("lda %v", uip_appdata); |
oliverschmidt | d36173a | 2005-01-22 02:56:00 +0000 | [diff] [blame] | 204 | asm("sta ptr1"); |
oliverschmidt | 2fa3323 | 2005-01-26 21:33:29 +0000 | [diff] [blame] | 205 | asm("lda %v+1", uip_appdata); |
oliverschmidt | d36173a | 2005-01-22 02:56:00 +0000 | [diff] [blame] | 206 | asm("sta ptr1+1"); |
| 207 | |
oliverschmidt | d36173a | 2005-01-22 02:56:00 +0000 | [diff] [blame] | 208 | asm("ldy #0"); |
oliverschmidt | ac66124 | 2005-03-09 23:31:23 +0000 | [diff] [blame] | 209 | sendloop2: |
oliverschmidt | d36173a | 2005-01-22 02:56:00 +0000 | [diff] [blame] | 210 | asm("lda (ptr1),y"); |
oliverschmidt | 2fa3323 | 2005-01-26 21:33:29 +0000 | [diff] [blame] | 211 | asm("sta %v,x", cs8900a_rxtxreg); |
oliverschmidt | d36173a | 2005-01-22 02:56:00 +0000 | [diff] [blame] | 212 | asm("iny"); |
| 213 | asm("lda (ptr1),y"); |
oliverschmidt | 2fa3323 | 2005-01-26 21:33:29 +0000 | [diff] [blame] | 214 | asm("sta %v+1,x", cs8900a_rxtxreg); |
oliverschmidt | d36173a | 2005-01-22 02:56:00 +0000 | [diff] [blame] | 215 | asm("iny"); |
oliverschmidt | ac66124 | 2005-03-09 23:31:23 +0000 | [diff] [blame] | 216 | asm("bne %g", check); |
oliverschmidt | d36173a | 2005-01-22 02:56:00 +0000 | [diff] [blame] | 217 | asm("inc ptr1+1"); |
oliverschmidt | ac66124 | 2005-03-09 23:31:23 +0000 | [diff] [blame] | 218 | check: |
oliverschmidt | b65645c | 2005-03-13 21:15:26 +0000 | [diff] [blame] | 219 | asm("cpy %v", cnt); |
oliverschmidt | ac66124 | 2005-03-09 23:31:23 +0000 | [diff] [blame] | 220 | asm("bne %g", sendloop2); |
oliverschmidt | b65645c | 2005-03-13 21:15:26 +0000 | [diff] [blame] | 221 | asm("dec %v+1", cnt); |
oliverschmidt | ac66124 | 2005-03-09 23:31:23 +0000 | [diff] [blame] | 222 | asm("bpl %g", sendloop2); |
oliverschmidt | d36173a | 2005-01-22 02:56:00 +0000 | [diff] [blame] | 223 | } |
| 224 | #pragma optimize(pop) |
| 225 | /*-----------------------------------------------------------------------------------*/ |
| 226 | #pragma optimize(push, off) |
| 227 | static void |
| 228 | skip_frame(void) |
| 229 | { |
oliverschmidt | 2fa3323 | 2005-01-26 21:33:29 +0000 | [diff] [blame] | 230 | asm("ldx %v", idx); |
| 231 | |
oliverschmidt | d36173a | 2005-01-22 02:56:00 +0000 | [diff] [blame] | 232 | /* PACKETPP = 0x0102; |
| 233 | PPDATA = PPDATA | 0x0040; */ |
| 234 | asm("lda #$02"); |
oliverschmidt | 2fa3323 | 2005-01-26 21:33:29 +0000 | [diff] [blame] | 235 | asm("sta %v,x", cs8900a_packetpp); |
oliverschmidt | d36173a | 2005-01-22 02:56:00 +0000 | [diff] [blame] | 236 | asm("lda #$01"); |
oliverschmidt | 2fa3323 | 2005-01-26 21:33:29 +0000 | [diff] [blame] | 237 | asm("sta %v+1,x", cs8900a_packetpp); |
| 238 | asm("lda %v,x", cs8900a_ppdata); |
oliverschmidt | d36173a | 2005-01-22 02:56:00 +0000 | [diff] [blame] | 239 | asm("ora #$40"); |
oliverschmidt | 2fa3323 | 2005-01-26 21:33:29 +0000 | [diff] [blame] | 240 | asm("sta %v,x", cs8900a_ppdata); |
oliverschmidt | d36173a | 2005-01-22 02:56:00 +0000 | [diff] [blame] | 241 | } |
| 242 | #pragma optimize(pop) |
| 243 | /*-----------------------------------------------------------------------------------*/ |
| 244 | #pragma optimize(push, off) |
oliverschmidt | 2fa3323 | 2005-01-26 21:33:29 +0000 | [diff] [blame] | 245 | u16_t |
oliverschmidt | d36173a | 2005-01-22 02:56:00 +0000 | [diff] [blame] | 246 | cs8900a_poll(void) |
| 247 | { |
oliverschmidt | 2fa3323 | 2005-01-26 21:33:29 +0000 | [diff] [blame] | 248 | asm("ldx %v", idx); |
oliverschmidt | ac66124 | 2005-03-09 23:31:23 +0000 | [diff] [blame] | 249 | asm("beq %g", bailout); |
oliverschmidt | 2fa3323 | 2005-01-26 21:33:29 +0000 | [diff] [blame] | 250 | |
oliverschmidt | d36173a | 2005-01-22 02:56:00 +0000 | [diff] [blame] | 251 | /* Check receiver event register to see if there are any valid |
| 252 | unicast frames avaliable. */ |
| 253 | /* PACKETPP = 0x0124; |
| 254 | if(PPDATA & 0x000d == 0x0000) { |
| 255 | return 0; |
| 256 | } |
| 257 | */ |
| 258 | asm("lda #$24"); |
oliverschmidt | 2fa3323 | 2005-01-26 21:33:29 +0000 | [diff] [blame] | 259 | asm("sta %v,x", cs8900a_packetpp); |
oliverschmidt | d36173a | 2005-01-22 02:56:00 +0000 | [diff] [blame] | 260 | asm("lda #$01"); |
oliverschmidt | 2fa3323 | 2005-01-26 21:33:29 +0000 | [diff] [blame] | 261 | asm("sta %v+1,x", cs8900a_packetpp); |
| 262 | asm("lda %v+1,x", cs8900a_ppdata); |
oliverschmidt | d36173a | 2005-01-22 02:56:00 +0000 | [diff] [blame] | 263 | asm("and #$0d"); |
| 264 | asm("cmp #$00"); |
oliverschmidt | ac66124 | 2005-03-09 23:31:23 +0000 | [diff] [blame] | 265 | asm("bne %g", noreturn); |
oliverschmidt | d36173a | 2005-01-22 02:56:00 +0000 | [diff] [blame] | 266 | /* No frame ready. */ |
oliverschmidt | ac66124 | 2005-03-09 23:31:23 +0000 | [diff] [blame] | 267 | bailout: |
oliverschmidt | d36173a | 2005-01-22 02:56:00 +0000 | [diff] [blame] | 268 | return 0; |
| 269 | |
oliverschmidt | ac66124 | 2005-03-09 23:31:23 +0000 | [diff] [blame] | 270 | noreturn: |
oliverschmidt | d36173a | 2005-01-22 02:56:00 +0000 | [diff] [blame] | 271 | /* Process the incoming frame. */ |
| 272 | |
| 273 | /* Read receiver event and discard it. */ |
oliverschmidt | 2fa3323 | 2005-01-26 21:33:29 +0000 | [diff] [blame] | 274 | /* RXTXREG; */ |
| 275 | asm("lda %v+1,x", cs8900a_rxtxreg); |
| 276 | asm("lda %v,x", cs8900a_rxtxreg); |
oliverschmidt | d36173a | 2005-01-22 02:56:00 +0000 | [diff] [blame] | 277 | |
| 278 | /* Read frame length. */ |
oliverschmidt | 2fa3323 | 2005-01-26 21:33:29 +0000 | [diff] [blame] | 279 | /* cnt = len = RXTXREG; */ |
| 280 | asm("lda %v+1,x", cs8900a_rxtxreg); |
| 281 | asm("sta %v+1", len); |
| 282 | asm("sta %v+1", cnt); |
| 283 | asm("lda %v,x", cs8900a_rxtxreg); |
| 284 | asm("sta %v", len); |
| 285 | asm("sta %v", cnt); |
oliverschmidt | d36173a | 2005-01-22 02:56:00 +0000 | [diff] [blame] | 286 | |
oliverschmidt | 2fa3323 | 2005-01-26 21:33:29 +0000 | [diff] [blame] | 287 | asm("lsr"); |
oliverschmidt | ac66124 | 2005-03-09 23:31:23 +0000 | [diff] [blame] | 288 | asm("bcc %g", noinc); |
oliverschmidt | 2fa3323 | 2005-01-26 21:33:29 +0000 | [diff] [blame] | 289 | asm("inc %v", cnt); |
oliverschmidt | ac66124 | 2005-03-09 23:31:23 +0000 | [diff] [blame] | 290 | asm("bne %g", noinc); |
oliverschmidt | 2fa3323 | 2005-01-26 21:33:29 +0000 | [diff] [blame] | 291 | asm("inc %v+1", cnt); |
oliverschmidt | ac66124 | 2005-03-09 23:31:23 +0000 | [diff] [blame] | 292 | noinc: |
oliverschmidt | 2fa3323 | 2005-01-26 21:33:29 +0000 | [diff] [blame] | 293 | |
| 294 | if(cnt > UIP_BUFSIZE) { |
oliverschmidt | d36173a | 2005-01-22 02:56:00 +0000 | [diff] [blame] | 295 | skip_frame(); |
| 296 | return 0; |
| 297 | } |
oliverschmidt | 2fa3323 | 2005-01-26 21:33:29 +0000 | [diff] [blame] | 298 | |
oliverschmidt | d36173a | 2005-01-22 02:56:00 +0000 | [diff] [blame] | 299 | /* Read bytes into uip_buf. */ |
oliverschmidt | 2fa3323 | 2005-01-26 21:33:29 +0000 | [diff] [blame] | 300 | asm("ldx %v", idx); |
| 301 | |
oliverschmidt | 2fa3323 | 2005-01-26 21:33:29 +0000 | [diff] [blame] | 302 | asm("lda #<%v", uip_buf); |
oliverschmidt | d36173a | 2005-01-22 02:56:00 +0000 | [diff] [blame] | 303 | asm("sta ptr1"); |
oliverschmidt | 2fa3323 | 2005-01-26 21:33:29 +0000 | [diff] [blame] | 304 | asm("lda #>%v", uip_buf); |
oliverschmidt | d36173a | 2005-01-22 02:56:00 +0000 | [diff] [blame] | 305 | asm("sta ptr1+1"); |
| 306 | |
oliverschmidt | d36173a | 2005-01-22 02:56:00 +0000 | [diff] [blame] | 307 | asm("ldy #0"); |
oliverschmidt | ac66124 | 2005-03-09 23:31:23 +0000 | [diff] [blame] | 308 | readloop: |
oliverschmidt | 2fa3323 | 2005-01-26 21:33:29 +0000 | [diff] [blame] | 309 | asm("lda %v,x", cs8900a_rxtxreg); |
oliverschmidt | d36173a | 2005-01-22 02:56:00 +0000 | [diff] [blame] | 310 | asm("sta (ptr1),y"); |
| 311 | asm("iny"); |
oliverschmidt | 2fa3323 | 2005-01-26 21:33:29 +0000 | [diff] [blame] | 312 | asm("lda %v+1,x", cs8900a_rxtxreg); |
oliverschmidt | d36173a | 2005-01-22 02:56:00 +0000 | [diff] [blame] | 313 | asm("sta (ptr1),y"); |
| 314 | asm("iny"); |
oliverschmidt | ac66124 | 2005-03-09 23:31:23 +0000 | [diff] [blame] | 315 | asm("bne %g", check); |
oliverschmidt | 2fa3323 | 2005-01-26 21:33:29 +0000 | [diff] [blame] | 316 | asm("inc ptr1+1"); |
oliverschmidt | ac66124 | 2005-03-09 23:31:23 +0000 | [diff] [blame] | 317 | check: |
oliverschmidt | 2fa3323 | 2005-01-26 21:33:29 +0000 | [diff] [blame] | 318 | asm("cpy %v", cnt); |
oliverschmidt | ac66124 | 2005-03-09 23:31:23 +0000 | [diff] [blame] | 319 | asm("bne %g", readloop); |
oliverschmidt | 2fa3323 | 2005-01-26 21:33:29 +0000 | [diff] [blame] | 320 | asm("dec %v+1", cnt); |
oliverschmidt | ac66124 | 2005-03-09 23:31:23 +0000 | [diff] [blame] | 321 | asm("bpl %g", readloop); |
oliverschmidt | d36173a | 2005-01-22 02:56:00 +0000 | [diff] [blame] | 322 | return len; |
| 323 | } |
| 324 | #pragma optimize(pop) |