110 lines
2.8 KiB
C
110 lines
2.8 KiB
C
#include <stdio.h>
|
|
#include <stdint.h>
|
|
#include <string.h>
|
|
#include "hexdump.h"
|
|
#include "scc.h"
|
|
#include "ddp.h"
|
|
#include "ethertalk.h"
|
|
#include <alloca.h>
|
|
|
|
//LLAP type 0x01-0x7F are for data
|
|
#define LLAP_TYPE_ENQ 0x81
|
|
#define LLAP_TYPE_ACK 0x82
|
|
#define LLAP_TYPE_RTS 0x84
|
|
#define LLAP_TYPE_CTS 0x85
|
|
|
|
#define LLAP_TYPE_DDP_SHORT 1
|
|
#define LLAP_TYPE_DDP_LONG 2
|
|
|
|
typedef struct {
|
|
uint8_t destid; //dest 255 is broadcast
|
|
uint8_t srcid;
|
|
uint8_t type;
|
|
uint8_t data[];
|
|
} llap_packet_t;
|
|
|
|
/*
|
|
llap plus short ddp example:
|
|
00000000 ff 48 01 00 06 01 01 05 01 |.H.......|
|
|
dest ff
|
|
src 48
|
|
type 01 (ddp short)
|
|
ddp len 00 06
|
|
dest sock 01
|
|
src sock 01
|
|
ddp type 5
|
|
data 1
|
|
*/
|
|
|
|
|
|
void localtalkSend(uint8_t *data, int len) {
|
|
llap_packet_t *p=(llap_packet_t*)data;
|
|
printf("\n\nLOCALTALK PACKET FROM TME MAC\n");
|
|
if (p->type==LLAP_TYPE_ENQ) {
|
|
ethertalk_send_probe(p->destid);
|
|
printf("LocalTalk: enq %hhu->%hhu\n", p->srcid, p->destid);
|
|
} else if (p->type==LLAP_TYPE_RTS) {
|
|
printf("LocalTalk: RTS %hhu->%hhu\n", p->srcid, p->destid);
|
|
if (p->destid!=0xff) {
|
|
printf("Sending CTS.\n");
|
|
uint8_t resp[3];
|
|
llap_packet_t *r=(llap_packet_t*)resp;
|
|
r->destid=p->srcid;
|
|
r->srcid=p->destid;
|
|
r->type=LLAP_TYPE_CTS;
|
|
sccRecv(1, r, sizeof(llap_packet_t), 3);
|
|
}
|
|
} else if (p->type==LLAP_TYPE_DDP_SHORT) {
|
|
printf("Localtalk: DDP short %hhu->%hhu\n", p->srcid, p->destid);
|
|
ddp_print(p->data, len-sizeof(llap_packet_t), 0);
|
|
ethertalk_send_short_ddp(p->data, len-sizeof(llap_packet_t), p->srcid, p->destid);
|
|
// hexdump(data, len);
|
|
} else if (p->type==LLAP_TYPE_DDP_LONG) {
|
|
printf("Localtalk: DDP long\n");
|
|
ddp_print(p->data, len-sizeof(llap_packet_t), 1);
|
|
ethertalk_send_long_ddp(p->data, len-sizeof(llap_packet_t));
|
|
// hexdump(data, len);
|
|
} else {
|
|
printf("LocalTalk... errm... dunno what to do with this (cmd=%x).\n", data[2]);
|
|
}
|
|
}
|
|
|
|
void localtalk_send_ddp(uint8_t *data, int len) {
|
|
llap_packet_t rts;
|
|
rts.destid=ddp_get_dest_node(data);
|
|
rts.srcid=ddp_get_src_node(data);
|
|
rts.type=LLAP_TYPE_RTS;
|
|
sccRecv(1, &rts, 3, 3);
|
|
|
|
//We assume this is a long ddp packet.
|
|
#if 0
|
|
llap_packet_t *p=alloca(len+sizeof(llap_packet_t));
|
|
p->destid=ddp_get_dest_node(data);
|
|
p->srcid=ddp_get_src_node(data);
|
|
p->type=LLAP_TYPE_DDP_SHORT;
|
|
int plen=ddp_long_to_short(data, p->data, len);
|
|
sccRecv(1, p, plen+sizeof(llap_packet_t), 2);
|
|
#else
|
|
printf("Localtalk: Sending ddp of len %d for a total of %d\n", len, len+sizeof(llap_packet_t));
|
|
llap_packet_t *p=alloca(len+sizeof(llap_packet_t));
|
|
p->destid=ddp_get_dest_node(data);
|
|
p->srcid=ddp_get_src_node(data);
|
|
p->type=LLAP_TYPE_DDP_LONG;
|
|
memcpy(p->data, data, len);
|
|
sccRecv(1, p, len+sizeof(llap_packet_t), 2);
|
|
#endif
|
|
}
|
|
|
|
void localtalk_send_llap_resp(uint8_t node) {
|
|
//ToDo
|
|
}
|
|
|
|
//Called once every now and then.
|
|
void localtalkTick() {
|
|
ethertalkTick();
|
|
}
|
|
|
|
void localtalkInit() {
|
|
ethertalkInit();
|
|
}
|