Sha256: d6a55e72c6dd024d2987858478cb0bc4331b4de01aa7478ebb9ab978bb9998bb
Contents?: true
Size: 1.55 KB
Versions: 46
Compression:
Stored size: 1.55 KB
Contents
#
# wgs2tky.rb
# -- GPS data converter
#
# kp<kp@mmho.no-ip.org>
# Destributed under the GPL
class Wgs2Tky
Pi = Math::PI
Rd = Pi/180
# WGS84
A = 6378137.0 # 赤道半径
F = 1/298.257223563 # 扁平率
E2 = F*2 - F*F # 第一離心率
# Tokyo
A_ = 6378137.0 - 739.845 # 6377397.155
F_ = 1/298.257223563 - 0.000010037483
# 1 / 299.152813
E2_ = F_*2 - F_*F_
Dx = +128
Dy = -481
Dz = -664
def Wgs2Tky.conv!(lat,lon,h = 0)
b = lat[0].to_f + lat[1].to_f/60 + lat[2].to_f/3600
l = lon[0].to_f + lon[1].to_f/60 + lon[2].to_f/3600
(x,y,z) = Wgs2Tky._llh2xyz(b,l,h,A,E2)
x+=Dx
y+=Dy
z+=Dz
(b,l,h) = Wgs2Tky._xyz2llh(x,y,z,A_,E2_)
lat[0..2]=Wgs2Tky._deg2gdms(b)
lon[0..2]=Wgs2Tky._deg2gdms(l)
end
private
include Math
extend Math
def Wgs2Tky._llh2xyz(b,l,h,a,e2)
b *= Rd
l *= Rd
sb = sin(b)
cb = cos(b)
rn = a / Math.sqrt(1-e2*sb*sb)
x = (rn+h)*cb*cos(l)
y = (rn+h)*cb*sin(l)
z = (rn*(1-e2)+h) * sb
return x,y,z
end
def Wgs2Tky._xyz2llh(x,y,z,a,e2)
bda = sqrt(1-e2)
po = sqrt(x*x+y*y)
t = atan2(z,po*bda)
st = sin(t)
ct = cos(t)
b = atan2(z+e2*a/bda*st*st*st,po-e2*a*ct*ct*ct)
l = atan2(y,x)
sb = sin(b)
rn = a / sqrt(1-e2*sb*sb)
h = po / cos(b) - rn
return b/Rd,l/Rd,h
end
def Wgs2Tky._deg2gdms(deg)
sf = deg*3600
s = sf.to_i%60
m = (sf/60).to_i%60
d = (sf/3600).to_i
s += sf - sf.to_i
return d,m,s
end
end
Version data entries
46 entries across 40 versions & 2 rubygems