View difference between Paste ID: bpAvLjcy and wvirT4TC
SHOW: | | - or go back to the newest paste.
1
local config = dofile "config.lua"
2
local modems = {}
3
local defaults = {[gps.CHANNEL_GPS] = true, [999] = true}
4
for name, location in pairs(config.modems) do
5
	modems[name] = peripheral.wrap(name)
6-
	modems[name].open(gps.CHANNEL_GPS)
6+
7
	modems[name].closeAll()
8
	for def in pairs(defaults) do
9
		modems[name].open(def)
10
	end
11
end
12
local has_open = {}
13
local has_open_map = {}
14
15
local vla_modem = peripheral.wrap(config.vla_modem or "bottom")
16
vla_modem.open(31415)
17
18
local function timestamp()
19
    return os.date "!%X"
20
end
21
22
-- Trilateration code from GPS and modified slightly
23
24
local function trilaterate( A, B, C )
25
    local a2b = B.position - A.position
26
    local a2c = C.position - A.position
27
       
28
    if math.abs( a2b:normalize():dot( a2c:normalize() ) ) > 0.999 then
29
        return nil
30
    end
31
   
32
    local d = a2b:length()
33
    local ex = a2b:normalize( )
34
    local i = ex:dot( a2c )
35
    local ey = (a2c - (ex * i)):normalize()
36
    local j = ey:dot( a2c )
37
    local ez = ex:cross( ey )
38
 
39
    local r1 = A.distance
40
    local r2 = B.distance
41
    local r3 = C.distance
42
       
43
    local x = (r1*r1 - r2*r2 + d*d) / (2*d)
44
    local y = (r1*r1 - r3*r3 - x*x + (x-i)*(x-i) + j*j) / (2*j)
45
       
46
    local result = A.position + (ex * x) + (ey * y)
47
 
48
    local zSquared = r1*r1 - x*x - y*y
49
    if zSquared > 0 then
50
        local z = math.sqrt( zSquared )
51
        local result1 = result + (ez * z)
52
        local result2 = result - (ez * z)
53
       
54
        local rounded1, rounded2 = result1:round( 0.01 ), result2:round( 0.01 )
55
        if rounded1.x ~= rounded2.x or rounded1.y ~= rounded2.y or rounded1.z ~= rounded2.z then
56
            return rounded1, rounded2
57
        else
58
            return rounded1
59
        end
60
    end
61
    return result:round( 0.01 )
62
end
63
 
64
local function narrow( p1, p2, fix )
65
    local dist1 = math.abs( (p1 - fix.position):length() - fix.distance )
66
    local dist2 = math.abs( (p2 - fix.position):length() - fix.distance )
67
   
68-
local function short_float(x)
68+
69-
	return ("%.0f"):format(x)
69+
70
    elseif dist1 < dist2 then
71
        return p1:round( 0.01 )
72-
local monitor = peripheral.find "monitor"
72+
73-
if monitor then
73+
74-
	monitor.setTextScale(0.5)
74+
75-
	term.redirect(monitor)
75+
76
77
local function compact_serialize(x, hist)
78-
print(timestamp(), "Initialized")
78+
    local t = type(x)
79
    if t == "string" then
80
        return ("%q"):format(x)
81
    elseif t == "table" then
82
		if hist[x] then return "[recursion]" end
83
		hist[x] = true
84-
	if distance and message == "PING" then
84+
        local out = "{ "
85
        for k, v in pairs(x) do
86-
		reply_modem.transmit(reply_channel, gps.CHANNEL_GPS, {
86+
            out = out .. string.format("[%s]=%s, ", compact_serialize(k, hist), compact_serialize(v, hist))
87-
			reply_modem.location[1], reply_modem.location[2], reply_modem.location[3], dimension = config.dimension, server = config.server
87+
88-
		})
88+
        return out .. "}"
89
    else
90
        return tostring(x)
91
    end
92
end
93
94-
				print(timestamp(), ("Ping from %.0f %.0f %.0f"):format(pos.x, pos.y, pos.z))
94+
local monitors = {}
95
for name, monitor in pairs(config.monitors) do
96
	monitors[name] = peripheral.wrap(monitor)
97
	monitors[name].setTextScale(0.5)
98
end
99
100
local function write_to(mon, ...)
101
	term.redirect(monitors[mon])
102
	print(...)
103
end
104
105
for name in pairs(monitors) do
106
	write_to(name, timestamp(), "Initialized")
107
end
108
109
local fixes = {}
110
111
while true do
112
	local _, modem, channel, reply_channel, message, distance = os.pullEvent "modem_message"
113
	if channel == 31415 and type(message) == "table" and modem == peripheral.getName(vla_modem) and message.origin == "VLA by Anavrins" and message.dimension == "Nether/End" and type(message.replyChannel) == "number" and type(message.senderChannel) == "number" and not defaults[message.senderChannel] then
114
		write_to("vla", timestamp(), ("%d->%d %s"):format(message.senderChannel, message.replyChannel, compact_serialize(message.message, {})))
115
		local newchan = message.senderChannel
116
		if not has_open_map[newchan] then
117
			write_to("vla", "Opening", newchan)
118
			if #has_open == 126 then
119
				local oldchan = table.remove(has_open, 1)
120
				write_to("vla", "Closing", oldchan)
121
				for name, modem in pairs(modems) do
122
					modem.close(oldchan)
123
				end
124
			end
125
			for name, modem in pairs(modems) do
126
				modem.open(newchan)
127
			end
128
			table.insert(has_open, newchan)
129
			has_open_map[newchan] = true
130
		end
131
	elseif distance and (has_open_map[channel] or defaults[channel]) then
132
		local reply_modem = modems[modem]
133
		if message == "PING" and channel == gps.CHANNEL_GPS then
134
			reply_modem.transmit(reply_channel, gps.CHANNEL_GPS, { reply_modem.location[1], reply_modem.location[2], reply_modem.location[3], dimension = config.dimension, server = config.server })
135
		end
136
		table.insert(fixes, { position = vector.new(unpack(reply_modem.location)), distance = distance })
137
		if #fixes == 4 then
138
			local p1, p2 = trilaterate(fixes[1], fixes[2], fixes[3])
139
			if p1 and p2 then
140
				local pos = narrow(p1, p2, fixes[4])
141
				if channel == gps.CHANNEL_GPS then
142
					write_to("gps", timestamp(), ("%d: %.0f %.0f %.0f"):format(reply_channel, pos.x, pos.y, pos.z))
143
				elseif channel == 999 then
144
					local status, label = "?", "?"
145
					if type(message) == "table" then status = tostring(message.status) label = tostring(message.label) end
146
					write_to("opus", timestamp(), ("%05d %s (%.0f %.0f %.0f) %s"):format(reply_channel, label, pos.x, pos.y, pos.z, status))
147
				else
148
					write_to("vla", timestamp(), ("-> %.0f %.0f %.0f"):format(pos.x, pos.y, pos.z))
149
				end
150
			end
151
			fixes = {}
152
		end
153
	end
154
end