View difference between Paste ID: TJtCc84e and wvirT4TC
SHOW: | | - or go back to the newest paste.
1
local config = dofile "config.lua"
2
local modems = {}
3
for name, location in pairs(config.modems) do
4
	modems[name] = peripheral.wrap(name)
5
	modems[name].location = location
6-
	modems[name].open(gps.CHANNEL_GPS)
6+
	modems[name].open(21592)
7
end
8
9-
local function timestamp()
9+
local key = config.spudnet_key
10-
    return os.date "!%X"
10+
if not key then error "SPUDNET key not found." end
11
local ws
12
 
13
local function connect()
14
	while true do
15
		ws, err = http.websocket("wss://osmarks.tk/wsthing/SGNS/admin", { authorization = "Key " .. key })
16
		if err then
17
			printError(err)
18
			sleep(1)
19
		else
20
			break
21
		end
22
	end
23
end
24
25
connect()
26
27
local function send(msg)
28
	local ok, err = pcall(ws.send, json.encode(msg))
29
	if not ok then
30
		connect()
31
	end
32
end
33
34
-- Trilateration code from GPS and modified slightly
35
36
local function trilaterate( A, B, C )
37
    local a2b = B.position - A.position
38
    local a2c = C.position - A.position
39
       
40
    if math.abs( a2b:normalize():dot( a2c:normalize() ) ) > 0.999 then
41
        return nil
42
    end
43
   
44
    local d = a2b:length()
45
    local ex = a2b:normalize( )
46
    local i = ex:dot( a2c )
47
    local ey = (a2c - (ex * i)):normalize()
48
    local j = ey:dot( a2c )
49
    local ez = ex:cross( ey )
50
 
51
    local r1 = A.distance
52
    local r2 = B.distance
53
    local r3 = C.distance
54
       
55
    local x = (r1*r1 - r2*r2 + d*d) / (2*d)
56
    local y = (r1*r1 - r3*r3 - x*x + (x-i)*(x-i) + j*j) / (2*j)
57
       
58
    local result = A.position + (ex * x) + (ey * y)
59
 
60
    local zSquared = r1*r1 - x*x - y*y
61
    if zSquared > 0 then
62
        local z = math.sqrt( zSquared )
63
        local result1 = result + (ez * z)
64
        local result2 = result - (ez * z)
65
       
66
        local rounded1, rounded2 = result1:round( 0.01 ), result2:round( 0.01 )
67
        if rounded1.x ~= rounded2.x or rounded1.y ~= rounded2.y or rounded1.z ~= rounded2.z then
68-
local function short_float(x)
68+
69-
	return ("%.0f"):format(x)
69+
70
            return rounded1
71
        end
72-
local monitor = peripheral.find "monitor"
72+
73-
if monitor then
73+
74-
	monitor.setTextScale(0.5)
74+
75-
	term.redirect(monitor)
75+
76
local function narrow( p1, p2, fix )
77
    local dist1 = math.abs( (p1 - fix.position):length() - fix.distance )
78-
print(timestamp(), "Initialized")
78+
79
   
80
    if math.abs(dist1 - dist2) < 0.01 then
81
        return p1, p2
82
    elseif dist1 < dist2 then
83
        return p1:round( 0.01 )
84-
	if distance and message == "PING" then
84+
85
        return p2:round( 0.01 )
86-
		reply_modem.transmit(reply_channel, gps.CHANNEL_GPS, {
86+
87-
			reply_modem.location[1], reply_modem.location[2], reply_modem.location[3], dimension = config.dimension, server = config.server
87+
88-
		})
88+
89
local fixes = {}
90
91
while true do
92
	local _, modem, channel, reply_channel, message, distance = os.pullEvent "modem_message"
93
	if distance and (type(message) == "string" or type(message) == "number") then
94-
				print(timestamp(), ("Ping from %.0f %.0f %.0f"):format(pos.x, pos.y, pos.z))
94+
95
		reply_modem.transmit(reply_channel, gps.CHANNEL_GPS, reply_modem.location)
96
		table.insert(fixes, { position = vector.new(unpack(reply_modem.location)), distance = distance })
97
		if #fixes == 4 then
98
			local p1, p2 = trilaterate(fixes[1], fixes[2], fixes[3])
99
			if p1 and p2 then
100
				local pos = narrow(p1, p2, fixes[4])
101
				send { type = "position_fix", dimension = config.dimension, x = pos.x, y = pos.y, z = pos.z, ID = message }
102
			else
103
				send { type = "error", error = "position fix failed", ID = message }
104
			end
105
			fixes = {}
106
		end
107
	end
108
end