File "index2.py"

Full path: /www/gps_socket/backhoeCt/index2.py
File size: 1.58 KiB (1616 bytes)
MIME-type: text/plain
Charset: utf-8

Download   Open   Back

# -*- coding: utf-8 -*-

import pyproj
import pandas as pd
import sys

grs80 = pyproj.Geod(ellps='GRS80')

primary_lat = sys.argv[4]
primary_lon =  sys.argv[5]

secondary_lat = sys.argv[7]
secondary_lon = sys.argv[8]

# 方位角算出
result = grs80.inv(primary_lon,primary_lat,secondary_lon,secondary_lat)
result_azimuth = result[0]
LiDAR_azimuth = result_azimuth + 360 - 90          #方位の方向要注意

f = open('/www/gps_socket/backhoeCt/LiDAR_azimuth.txt', 'a')
f.write('LiDAR_azimuth==' + str(LiDAR_azimuth) + '\n')
f.write(sys.argv[3] + ',' + sys.argv[1] + ' ' + sys.argv[2] + ',' + sys.argv[4] + ',' + sys.argv[5] + '\n')
f.write(sys.argv[6] + ',' + sys.argv[1] + ' ' + sys.argv[2] + ',' + sys.argv[7] + ',' + sys.argv[8] + '\n')
f.close()


#スタートの方位角があるかチェック
if(len(sys.argv) != 11):
	f = open('/www/gps_socket/backhoeCt/ct_start_filename.txt', 'a')
	f.write(',' + str(LiDAR_azimuth) + '\n')
	f.close()
else:
	start_angle = float(sys.argv[10]);
	current_angle = LiDAR_azimuth
	f2 = open('/www/gps_socket/backhoeCt/ct_flag.txt', 'r')
	ct_flag = f2.read()
	f2.close()

	if current_angle > start_angle + 70:
		if int(ct_flag) == 0:
			f = open('/www/gps_socket/backhoeCt/data/' + sys.argv[9], 'a')
			f.write(sys.argv[1] + ' ' + sys.argv[2] + ',' + sys.argv[3] + ',' + sys.argv[6] + ',' +  sys.argv[10] + ',' + str(current_angle) + '\n')
			f.close()
			
			f3 = open('/www/gps_socket/backhoeCt/ct_flag.txt', 'w')
			f3.write('1')
			f3.close()

	if current_angle < start_angle + 70:
		f3 = open('/www/gps_socket/backhoeCt/ct_flag.txt', 'w')
		f3.write('0')
		f3.close()