junh_eee
2 years ago
7 changed files with 353 additions and 17 deletions
@ -0,0 +1,93 @@
|
||||
const {getConnection, writeData} = require("./pav-client") |
||||
const {dumyData} = require("./pav-utils") |
||||
|
||||
// const host = "192.168.0.24"
|
||||
// const host = "localhost"
|
||||
const host = "211.43.13.240" |
||||
const port = 8082 |
||||
|
||||
const prefix = 'TEST-DRON-' |
||||
const severalDrones = (cnt) => { |
||||
// 클라이언트 정보 저장공간
|
||||
const clients = []; |
||||
|
||||
|
||||
// 최초 좌표
|
||||
// y - y' : 37.57 -> 35.36
|
||||
// x - x' : 126.60 -> 128.94
|
||||
const firstCoord = [37.57, 126.6]; |
||||
const lastCoord = [35.36, 128.94]; |
||||
// 좌표 차이 계산
|
||||
const diffX = firstCoord[0] - lastCoord[0]; |
||||
const diffY = lastCoord[1] - firstCoord[1]; |
||||
// 구분점
|
||||
const divCnt = Math.round(Math.sqrt(cnt)); |
||||
const divDiifX = diffX / divCnt; |
||||
const divDiifY = diffY / divCnt; |
||||
|
||||
// 초기값 저장
|
||||
for (let i = 0; i < cnt; i++) { |
||||
const client = {}; |
||||
const suffix = i.toString().padStart(3, '0') |
||||
const dronName = prefix + suffix; |
||||
// client
|
||||
client.dronName = dronName; |
||||
client.socket = getConnection(dronName, host, port); |
||||
|
||||
const divX = i % divCnt; |
||||
const divY = Math.floor(i / divCnt); |
||||
const x = Number((firstCoord[0] - (divX * divDiifX)).toFixed(5)) || 0; |
||||
const y = Number((firstCoord[1] + (divY * divDiifY)).toFixed(5)) || 0; |
||||
|
||||
const initialData = { |
||||
...dumyData, |
||||
terminalId: dronName, |
||||
body: [ |
||||
{ |
||||
...dumyData.body[0], |
||||
objectId: dronName, |
||||
lat: x, |
||||
lon: y |
||||
} |
||||
] |
||||
} |
||||
client.data = initialData; |
||||
|
||||
console.log(dronName, x, y, JSON.stringify(initialData)) |
||||
clients.push(client); |
||||
} |
||||
return clients; |
||||
} |
||||
//
|
||||
const clients = severalDrones(100); |
||||
const dist = 0.01; |
||||
const sendData = (cnt) => { |
||||
const direction = Math.floor(cnt/10) % 4; |
||||
clients.forEach((item) => { |
||||
// console.log(cnt, item.data.body[0].lat, item.data.body[0].lon)
|
||||
switch (direction) { |
||||
case 1: |
||||
item.data.body[0].lat = Number((item.data.body[0].lat - dist).toFixed(5)) |
||||
break; |
||||
case 2: |
||||
item.data.body[0].lon = Number((item.data.body[0].lon - dist).toFixed(5)) |
||||
break; |
||||
case 3: |
||||
item.data.body[0].lat = Number((item.data.body[0].lat + dist).toFixed(5)) |
||||
break; |
||||
default: |
||||
item.data.body[0].lon = Number((item.data.body[0].lon + dist).toFixed(5)) |
||||
break; |
||||
} |
||||
|
||||
writeData(item.socket, JSON.stringify(item.data)); |
||||
}) |
||||
if(cnt >= 39) cnt = null; |
||||
iteratorSendData(++cnt); |
||||
} |
||||
|
||||
const iteratorSendData = (cnt = 0) => { |
||||
setTimeout(() => sendData(cnt), 1000); |
||||
} |
||||
|
||||
iteratorSendData(); |
@ -0,0 +1,47 @@
|
||||
const net = require('net'); |
||||
|
||||
|
||||
const getConnection = (connName, host, port) => { |
||||
const client = net.connect({port: port, host: host}, function () { |
||||
console.log(connName + ' Connected: '); |
||||
console.log(' local = %s:%s', this.localAddress, this.localPort); |
||||
console.log(' remote = %s:%s', this.remoteAddress, this.remotePort); |
||||
this.setTimeout(500); |
||||
this.setEncoding('utf8'); |
||||
this.on('data', function (data) { |
||||
console.log(connName + " From Server: " + data.toString()); |
||||
// this.end();
|
||||
}); |
||||
this.on('end', function () { |
||||
console.log(connName + ' Client disconnected'); |
||||
}); |
||||
this.on('error', function (err) { |
||||
console.log('Socket Error: ', err, JSON.stringify(err)); |
||||
}); |
||||
this.on('timeout', function () { |
||||
console.log('Socket Timed Out'); |
||||
}); |
||||
this.on('close', function (e) { |
||||
console.log('Socket Closed', e); |
||||
}); |
||||
}); |
||||
return client; |
||||
} |
||||
|
||||
const writeData = (socket, data) => { |
||||
const success = !!socket.write(data); |
||||
// if (success) {
|
||||
// (function (socket, data) {
|
||||
// socket.once('drain', function () {
|
||||
// writeData(socket, data);
|
||||
// });
|
||||
// })(socket, data);
|
||||
// }
|
||||
} |
||||
|
||||
// const Dwarves = getConnection("Dwarves");
|
||||
// writeData(Dwarves, JSON.stringify(sampleData));
|
||||
|
||||
|
||||
|
||||
module.exports = {getConnection, writeData} |
@ -0,0 +1,117 @@
|
||||
// degree -> radian 변환
|
||||
const deg2rad = (deg) => { |
||||
return deg * (Math.PI / 180); |
||||
} |
||||
const rad2deg = (rad) => { |
||||
return rad * (180 / Math.PI); |
||||
} |
||||
// 좌표간 거리계산
|
||||
const getDistanceFromCoordByMeter = (coord1, coord2) => { |
||||
const R = 6371; // Radius of the earth in km
|
||||
const dLat = deg2rad(coord2[0] - coord1[0]); // deg2rad below
|
||||
const dLon = deg2rad(coord2[1] - coord1[1]); |
||||
const a = Math.sin(dLat / 2) * Math.sin(dLat / 2) + Math.cos(deg2rad(coord1[0])) * Math.cos(deg2rad(coord2[0])) * Math.sin(dLon / 2) * Math.sin(dLon / 2); |
||||
const c = 2 * Math.atan2(Math.sqrt(a), Math.sqrt(1 - a)); |
||||
// var d = R * c; // Distance in km
|
||||
const d = R * c * 1000; // Distance in m
|
||||
return d; |
||||
} |
||||
// 두 좌표사이 특정 거리만큼의 좌표 추출
|
||||
const getCoordsFormBetweenCoord = (coord1, coord2, dist) => { |
||||
// console.log('init ===> ', {coord1, coord2, dist})
|
||||
const r = []; |
||||
// 처음 좌표
|
||||
r.push(coord1); |
||||
// 중간 좌표
|
||||
const totalDist = getDistanceFromCoordByMeter(coord1, coord2); |
||||
const dx = coord2[0] - coord1[0]; |
||||
const singX = dx < 0 ? -1 : 1; |
||||
const dy = coord2[1] - coord1[1]; |
||||
const singY = dy < 0 ? -1 : 1; |
||||
const m = dy / dx; |
||||
const rad = Math.atan(m) |
||||
|
||||
const currentTotalDist = Math.sqrt((dx ** 2) + (dy ** 2)) |
||||
const currentDivDist = (dist * currentTotalDist) / totalDist; |
||||
const div = Math.floor(currentTotalDist / currentDivDist); |
||||
|
||||
for (let i = 1; i <= div; i++) { |
||||
const currentDist = currentDivDist * i; |
||||
let x = coord1[0]; |
||||
let y = coord1[1]; |
||||
if (dx == 0) { |
||||
y += currentDist * singY; |
||||
} else if (dy == 0) { |
||||
x += currentDist * singX; |
||||
} else { |
||||
x += Math.cos(rad) * currentDist; |
||||
y += Math.sin(rad) * currentDist; |
||||
} |
||||
r.push([x, y]) |
||||
} |
||||
// 마지막 좌표
|
||||
r.push(coord2) |
||||
return r; |
||||
} |
||||
|
||||
const dumyData = { |
||||
"authKey": "1cc2e08e-0c5c-43b2-8d4d-cddd3de558e3", |
||||
"terminalId": "SANDBOX-01", |
||||
"command": "SANDBOX", |
||||
"body": [ |
||||
{ |
||||
"objectId": "JAL497", |
||||
"lat": 37.52097, |
||||
"lon": 126.6146, |
||||
"elevType": "M", |
||||
"elev": 125.4, |
||||
"speedType": "KM", |
||||
"speed": 145.8, |
||||
"heading": 227.94, |
||||
"terminalRcvDt": "20210629173145", |
||||
"betteryLevel": 91, |
||||
"betteryVoltage": 50, |
||||
"dronStatus": "TAKEOFF", |
||||
"moveDistance": 120, |
||||
"moveDistanceType": "M", |
||||
"sensorCo": 100.11, |
||||
"sensorSo2": 200.22, |
||||
"sensorNo2": 300.33, |
||||
"sensorO3": 400.44, |
||||
"sensorDust": 500.55 |
||||
} |
||||
] |
||||
} |
||||
|
||||
module.exports = {getDistanceFromCoordByMeter, deg2rad, getCoordsFormBetweenCoord, dumyData} |
||||
|
||||
|
||||
const test = () => { |
||||
const coord1 = [37.5210, 126.6082]; |
||||
// const coord2 = [37.5210, 126.6057]; // x 절편
|
||||
const coord2 = [37.5200, 126.6082]; // y 절편
|
||||
// const coord2 = [37.5220, 126.6057]; // 일반
|
||||
const r = getCoordsFormBetweenCoord(coord1, coord2, 10) |
||||
console.log(r) |
||||
for (let i = 1; i < r.length; i++) { |
||||
const dist = getDistanceFromCoordByMeter(r[i-1], r[i]); |
||||
console.log(dist) |
||||
} |
||||
} |
||||
|
||||
// test();
|
||||
|
||||
const test2 = () => { |
||||
let m = 10.5 / 14 |
||||
console.log(3 / 4, 13.5 / 18, (13.5 - 3) / (18 - 4)) |
||||
let rad = Math.atan(m); |
||||
let tan = Math.tan(rad) |
||||
let cos = Math.cos(rad) |
||||
let sin = Math.sin(rad) |
||||
console.log({rad, tan, cos, sin}) |
||||
let x = Math.cos(rad) * 15 |
||||
let y = Math.sin(rad) * 15 |
||||
console.log({x, y}) |
||||
|
||||
} |
||||
// test2();
|
@ -0,0 +1,78 @@
|
||||
const {getConnection, writeData} = require("./pav-client") |
||||
const {getCoordsFormBetweenCoord, dumyData} = require("./pav-utils") |
||||
|
||||
// const host = "192.168.0.24"
|
||||
// const host = "localhost"
|
||||
const host = "211.43.13.240" |
||||
const port = 8082 |
||||
|
||||
// 기본정보
|
||||
const prefix = 'TEST-DRON-W-' |
||||
|
||||
const pathSampleCoord = [ |
||||
[37.5215, 126.6050], |
||||
[37.5215, 126.6082], |
||||
[37.5210, 126.6082], |
||||
[37.5210, 126.6057], |
||||
[37.5205, 126.6057], |
||||
[37.5205, 126.6082], |
||||
[37.5200, 126.6082], |
||||
[37.5200, 126.6057], |
||||
[37.5195, 126.6057], |
||||
[37.5195, 126.6082], |
||||
[37.5190, 126.6082], |
||||
[37.5190, 126.6050] |
||||
] |
||||
|
||||
const divDist = 10 // [m]
|
||||
|
||||
// 특정거리에 따른 좌표 추출
|
||||
const getCoords = (coords) => { |
||||
if (!coords || coords.length < 1) return; |
||||
const totalCoords = []; |
||||
for (let i = 1; i < coords.length; i++) { |
||||
const divCoords = getCoordsFormBetweenCoord(coords[i - 1], coords[i], divDist); |
||||
totalCoords.push(...divCoords) |
||||
} |
||||
return totalCoords; |
||||
} |
||||
|
||||
const getClient = () => { |
||||
const dronName = prefix + '001'; |
||||
|
||||
const client = {}; |
||||
client.dronName = dronName |
||||
client.socket = getConnection(dronName, host, port); |
||||
client.data = getCoords(pathSampleCoord); |
||||
return client; |
||||
} |
||||
|
||||
const sendData = (client, cnt) => { |
||||
const data = { |
||||
...dumyData, |
||||
terminalId: client.dronName, |
||||
body: [ |
||||
{ |
||||
...dumyData.body[0], |
||||
objectId: client.dronName, |
||||
lat: client.data[cnt][0], |
||||
lon: client.data[cnt][1] |
||||
} |
||||
] |
||||
} |
||||
writeData(client.socket, JSON.stringify(data)); |
||||
iteratorSendData(++cnt); |
||||
} |
||||
|
||||
const client = getClient(); |
||||
|
||||
const iteratorSendData = (cnt = 0) => { |
||||
if(cnt >= client.data.length) { |
||||
client.socket.destroy() |
||||
return; |
||||
} |
||||
setTimeout(() => sendData(client, cnt), 1000); |
||||
} |
||||
|
||||
iteratorSendData() |
||||
|
Loading…
Reference in new issue