1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
|
#include "jvshost.h"
#include "jvsdev.h"
void jvs_host::add_device(jvs_device *dev)
{
if(first_device)
first_device->chain(dev);
else
first_device = dev;
}
void jvs_host::device_start()
{
save_item(NAME(send_size));
save_item(NAME(recv_size));
save_item(NAME(send_buffer));
save_item(NAME(recv_buffer));
save_item(NAME(recv_is_encoded));
}
void jvs_host::device_reset()
{
send_size = recv_size = 0;
recv_is_encoded = false;
memset(send_buffer, 0, sizeof(send_buffer));
memset(recv_buffer, 0, sizeof(recv_buffer));
}
jvs_host::jvs_host(const machine_config &mconfig, device_type type, const char *name, const char *tag, device_t *owner, UINT32 clock, const char *shortname, const char *source)
: device_t(mconfig, type, name, tag, owner, clock, shortname, source)
{
first_device = 0;
}
void jvs_host::push(UINT8 val)
{
send_buffer[send_size++] = val;
}
void jvs_host::commit_raw()
{
recv_size = 0;
if(!send_size)
return;
// Message must:
// - have a non-zero destination in the first byte
// - have the message length without the two header bytes but with the checksum byte in the second byte
// - have at least one command byte
if(send_size < 3 || send_buffer[0] == 0x00 || send_buffer[1] != send_size-1) {
logerror("JVS checksum error\n");
// "This message is crap" doesn't exist so call it checksum error
recv_buffer[0] = 0x00;
recv_buffer[1] = 0x02;
recv_buffer[2] = 0x03;
recv_size = 3;
} else {
if(first_device) {
first_device->message(send_buffer[0], send_buffer+2, send_size-2, recv_buffer+2, recv_size);
recv_is_encoded = false;
if(recv_size) {
// Add the reply header, host is always destination 0x00
recv_buffer[0] = 0x00;
recv_buffer[1] = recv_size+1;
recv_size += 2;
}
} else
recv_size = 0;
}
send_size = 0;
}
void jvs_host::commit_encoded()
{
recv_size = 0;
if(!send_size)
return;
decode(send_buffer, send_size);
commit_raw();
}
void jvs_host::get_raw_reply(const UINT8 *&buffer, UINT32 &size)
{
if(recv_is_encoded) {
decode(recv_buffer, recv_size);
recv_is_encoded = false;
}
buffer = recv_buffer;
size = recv_size;
}
void jvs_host::get_encoded_reply(const UINT8 *&buffer, UINT32 &size)
{
if(!recv_is_encoded) {
encode(recv_buffer, recv_size);
recv_is_encoded = true;
}
buffer = recv_buffer;
size = recv_size;
}
bool jvs_host::get_presence_line()
{
return first_device != 0;
}
bool jvs_host::get_address_set_line()
{
return first_device && first_device->get_address_set_line();
}
void jvs_host::encode(UINT8 *buffer, UINT32 &size)
{
if(!size)
return;
UINT32 add = 1;
for(UINT32 i=0; i<size; i++)
if(buffer[i] == 0xd0 || buffer[i] == 0xe0)
add++;
UINT32 nsize = size+add;
for(UINT32 i=size; i; i--) {
UINT8 t = buffer[i-1];
if(t == 0xd0 || t == 0xe0) {
buffer[i+add-1] = t-1;
buffer[i+add-2] = 0xd0;
add--;
} else
buffer[i+add-1] = t;
}
buffer[0] = 0xe0;
UINT8 sum = 0;
for(UINT32 i=1; i<nsize; i++)
sum += buffer[i];
buffer[nsize++] = sum;
size = nsize;
}
void jvs_host::decode(UINT8 *buffer, UINT32 &size)
{
if(!size)
return;
UINT32 pos = 0;
for(UINT32 i=0; i<size-1; i++) {
UINT8 t = buffer[i];
if(!i && t == 0xe0)
continue;
if(t == 0xd0) {
i++;
t = buffer[i]+1;
}
buffer[pos++] = t;
}
size = pos;
}
|