1 // SPDX-License-Identifier: GPL-2.0-or-later 2 /* 3 * 4 * Copyright Jonathan Naylor G4KLX (g4klx@g4klx.demon.co.uk) 5 * Copyright Darryl Miles G7LED (dlm@g7led.demon.co.uk) 6 */ 7 #include <linux/errno.h> 8 #include <linux/types.h> 9 #include <linux/socket.h> 10 #include <linux/in.h> 11 #include <linux/kernel.h> 12 #include <linux/timer.h> 13 #include <linux/string.h> 14 #include <linux/sockios.h> 15 #include <linux/net.h> 16 #include <linux/slab.h> 17 #include <net/ax25.h> 18 #include <linux/inet.h> 19 #include <linux/netdevice.h> 20 #include <linux/skbuff.h> 21 #include <net/sock.h> 22 #include <linux/uaccess.h> 23 #include <linux/fcntl.h> 24 #include <linux/mm.h> 25 #include <linux/interrupt.h> 26 #include <net/netrom.h> 27 28 /* 29 * This is where all NET/ROM frames pass, except for IP-over-NET/ROM which 30 * cannot be fragmented in this manner. 31 */ 32 void nr_output(struct sock *sk, struct sk_buff *skb) 33 { 34 struct sk_buff *skbn; 35 unsigned char transport[NR_TRANSPORT_LEN]; 36 int err, frontlen, len; 37 38 if (skb->len - NR_TRANSPORT_LEN > NR_MAX_PACKET_SIZE) { 39 /* Save a copy of the Transport Header */ 40 skb_copy_from_linear_data(skb, transport, NR_TRANSPORT_LEN); 41 skb_pull(skb, NR_TRANSPORT_LEN); 42 43 frontlen = skb_headroom(skb); 44 45 while (skb->len > 0) { 46 if ((skbn = sock_alloc_send_skb(sk, frontlen + NR_MAX_PACKET_SIZE, 0, &err)) == NULL) 47 return; 48 49 skb_reserve(skbn, frontlen); 50 51 len = (NR_MAX_PACKET_SIZE > skb->len) ? skb->len : NR_MAX_PACKET_SIZE; 52 53 /* Copy the user data */ 54 skb_copy_from_linear_data(skb, skb_put(skbn, len), len); 55 skb_pull(skb, len); 56 57 /* Duplicate the Transport Header */ 58 skb_push(skbn, NR_TRANSPORT_LEN); 59 skb_copy_to_linear_data(skbn, transport, 60 NR_TRANSPORT_LEN); 61 if (skb->len > 0) 62 skbn->data[4] |= NR_MORE_FLAG; 63 64 skb_queue_tail(&sk->sk_write_queue, skbn); /* Throw it on the queue */ 65 } 66 67 kfree_skb(skb); 68 } else { 69 skb_queue_tail(&sk->sk_write_queue, skb); /* Throw it on the queue */ 70 } 71 72 nr_kick(sk); 73 } 74 75 /* 76 * This procedure is passed a buffer descriptor for an iframe. It builds 77 * the rest of the control part of the frame and then writes it out. 78 */ 79 static void nr_send_iframe(struct sock *sk, struct sk_buff *skb) 80 { 81 struct nr_sock *nr = nr_sk(sk); 82 83 if (skb == NULL) 84 return; 85 86 skb->data[2] = nr->vs; 87 skb->data[3] = nr->vr; 88 89 if (nr->condition & NR_COND_OWN_RX_BUSY) 90 skb->data[4] |= NR_CHOKE_FLAG; 91 92 nr_start_idletimer(sk); 93 94 nr_transmit_buffer(sk, skb); 95 } 96 97 void nr_send_nak_frame(struct sock *sk) 98 { 99 struct sk_buff *skb, *skbn; 100 struct nr_sock *nr = nr_sk(sk); 101 102 if ((skb = skb_peek(&nr->ack_queue)) == NULL) 103 return; 104 105 if ((skbn = skb_clone(skb, GFP_ATOMIC)) == NULL) 106 return; 107 108 skbn->data[2] = nr->va; 109 skbn->data[3] = nr->vr; 110 111 if (nr->condition & NR_COND_OWN_RX_BUSY) 112 skbn->data[4] |= NR_CHOKE_FLAG; 113 114 nr_transmit_buffer(sk, skbn); 115 116 nr->condition &= ~NR_COND_ACK_PENDING; 117 nr->vl = nr->vr; 118 119 nr_stop_t1timer(sk); 120 } 121 122 void nr_kick(struct sock *sk) 123 { 124 struct nr_sock *nr = nr_sk(sk); 125 struct sk_buff *skb, *skbn; 126 unsigned short start, end; 127 128 if (nr->state != NR_STATE_3) 129 return; 130 131 if (nr->condition & NR_COND_PEER_RX_BUSY) 132 return; 133 134 if (!skb_peek(&sk->sk_write_queue)) 135 return; 136 137 start = (skb_peek(&nr->ack_queue) == NULL) ? nr->va : nr->vs; 138 end = (nr->va + nr->window) % NR_MODULUS; 139 140 if (start == end) 141 return; 142 143 nr->vs = start; 144 145 /* 146 * Transmit data until either we're out of data to send or 147 * the window is full. 148 */ 149 150 /* 151 * Dequeue the frame and copy it. 152 */ 153 skb = skb_dequeue(&sk->sk_write_queue); 154 155 do { 156 if ((skbn = skb_clone(skb, GFP_ATOMIC)) == NULL) { 157 skb_queue_head(&sk->sk_write_queue, skb); 158 break; 159 } 160 161 skb_set_owner_w(skbn, sk); 162 163 /* 164 * Transmit the frame copy. 165 */ 166 nr_send_iframe(sk, skbn); 167 168 nr->vs = (nr->vs + 1) % NR_MODULUS; 169 170 /* 171 * Requeue the original data frame. 172 */ 173 skb_queue_tail(&nr->ack_queue, skb); 174 175 } while (nr->vs != end && 176 (skb = skb_dequeue(&sk->sk_write_queue)) != NULL); 177 178 nr->vl = nr->vr; 179 nr->condition &= ~NR_COND_ACK_PENDING; 180 181 if (!nr_t1timer_running(sk)) 182 nr_start_t1timer(sk); 183 } 184 185 void nr_transmit_buffer(struct sock *sk, struct sk_buff *skb) 186 { 187 struct nr_sock *nr = nr_sk(sk); 188 unsigned char *dptr; 189 190 /* 191 * Add the protocol byte and network header. 192 */ 193 dptr = skb_push(skb, NR_NETWORK_LEN); 194 195 memcpy(dptr, &nr->source_addr, AX25_ADDR_LEN); 196 dptr[6] &= ~AX25_CBIT; 197 dptr[6] &= ~AX25_EBIT; 198 dptr[6] |= AX25_SSSID_SPARE; 199 dptr += AX25_ADDR_LEN; 200 201 memcpy(dptr, &nr->dest_addr, AX25_ADDR_LEN); 202 dptr[6] &= ~AX25_CBIT; 203 dptr[6] |= AX25_EBIT; 204 dptr[6] |= AX25_SSSID_SPARE; 205 dptr += AX25_ADDR_LEN; 206 207 *dptr++ = sysctl_netrom_network_ttl_initialiser; 208 209 if (!nr_route_frame(skb, NULL)) { 210 kfree_skb(skb); 211 nr_disconnect(sk, ENETUNREACH); 212 } 213 } 214 215 /* 216 * The following routines are taken from page 170 of the 7th ARRL Computer 217 * Networking Conference paper, as is the whole state machine. 218 */ 219 220 void nr_establish_data_link(struct sock *sk) 221 { 222 struct nr_sock *nr = nr_sk(sk); 223 224 nr->condition = 0x00; 225 nr->n2count = 0; 226 227 nr_write_internal(sk, NR_CONNREQ); 228 229 nr_stop_t2timer(sk); 230 nr_stop_t4timer(sk); 231 nr_stop_idletimer(sk); 232 nr_start_t1timer(sk); 233 } 234 235 /* 236 * Never send a NAK when we are CHOKEd. 237 */ 238 void nr_enquiry_response(struct sock *sk) 239 { 240 struct nr_sock *nr = nr_sk(sk); 241 int frametype = NR_INFOACK; 242 243 if (nr->condition & NR_COND_OWN_RX_BUSY) { 244 frametype |= NR_CHOKE_FLAG; 245 } else { 246 if (skb_peek(&nr->reseq_queue) != NULL) 247 frametype |= NR_NAK_FLAG; 248 } 249 250 nr_write_internal(sk, frametype); 251 252 nr->vl = nr->vr; 253 nr->condition &= ~NR_COND_ACK_PENDING; 254 } 255 256 void nr_check_iframes_acked(struct sock *sk, unsigned short nr) 257 { 258 struct nr_sock *nrom = nr_sk(sk); 259 260 if (nrom->vs == nr) { 261 nr_frames_acked(sk, nr); 262 nr_stop_t1timer(sk); 263 nrom->n2count = 0; 264 } else { 265 if (nrom->va != nr) { 266 nr_frames_acked(sk, nr); 267 nr_start_t1timer(sk); 268 } 269 } 270 } 271