0

私は Web を検索して、ATAN2 関数を使用せずに方位を計算する方法を見つけようとしています。このコードを見つけましたが、機能させることができません。PLC プログラムで使用する前に式を検証しようとしましたが、数値が正しく表示されません。どんな助けでも大歓迎です。

  y = sin(lon2-lon1)*cos(lat2)
  x = cos(lat1)*sin(lat2)-sin(lat1)*cos(lat2)*cos(lon2-lon1)
  if y > 0 then
    if x > 0 then tc1 = arctan(y/x)
    if x < 0 then tc1 = 180 - arctan(-y/x)
    if x = 0 then tc1 = 90
  if y < 0 then
    if x > 0 then tc1 = -arctan(-y/x)
    if x < 0 then tc1 = arctan(y/x)-180
    if x = 0 then tc1 = 270
  if y = 0 then
    if x > 0 then tc1 = 0
    if x < 0 then tc1 = 180
    if x = 0 then [the 2 points are the same]

遺伝子

4

1 に答える 1

0

あなたの方程式は大丈夫です。これは、bash での実用的な実装です。

# /bin/bash

DEG_PER_RAD=$(echo "scale=10; 180 / 3.141592653589" | bc)
function atan2 {
    if [ $(echo "scale=10; $1 > 0" | bc -l) -eq 1 ]
    then
        if [ $(echo "scale=10; $2 > 0" | bc -l) -eq 1 ]
        then
            a2=$(echo "scale=10; a($1 / $2)" | bc -l)
        fi
        if [ $(echo "scale=10; $2 < 0" | bc -l) -eq 1 ]
        then
            a2=$(echo "scale=10; 3.141592653589 - a(-1 * $1 / $2)" | bc -l)
        fi
        if [ $(echo "scale=10; $2 == 0" | bc -l) -eq 1 ]
        then
            a2=$(echo "scale=10; 3.141592653589 / 2" | bc -l)
        fi
    fi
    if [ $(echo "scale=10; $1 < 0" | bc -l) -eq 1 ]
    then
        if [ $(echo "scale=10; $2 > 0" | bc -l) -eq 1 ]
        then
            a2=$(echo "scale=10; -1 * a(-1 * $1 / $2)" | bc -l)
        fi
        if [ $(echo "scale=10; $2 < 0" | bc -l) -eq 1 ]
        then
            a2=$(echo "scale=10; a($1 / $2) - 3.141592653589" | bc -l)
        fi
        if [ $(echo "scale=10; $2 == 0" | bc -l) -eq 1 ]
        then
            a2=$(echo "scale=10; 3 * 3.141592653589 / 2" | bc -l)
        fi
    fi
    if [ $(echo "scale=10; $1 == 0" | bc -l) -eq 1 ]
    then
        if [ $(echo "scale=10; $2 > 0" | bc -l) -eq 1 ]
        then
            a2=0
        fi
        if [ $(echo "scale=10; $2 < 0" | bc -l) -eq 1 ]
        then
            a2=$(echo "scale=10; 3.141592653589" | bc -l)
        fi
        if [ $(echo "scale=10; $2 == 0" | bc -l) -eq 1 ]
        then
            a2=0
        fi
    fi
}

function get_bearing {
    rad_lat1=$(echo "scale=9; ("$1" / $DEG_PER_RAD)" | bc)
    rad_lon1=$(echo "scale=9; ("$2" / $DEG_PER_RAD)" | bc)
    rad_lat2=$(echo "scale=9; ("$3" / $DEG_PER_RAD)" | bc)
    rad_lon2=$(echo "scale=9; ("$4" / $DEG_PER_RAD)" | bc)

    dLon=$(echo "scale=10; $rad_lon2 - $rad_lon1" | bc -l)
    y=$(echo "scale=10; s($dLon) * c($rad_lat2)" | bc -l)
    x=$(echo "scale=10; (c($rad_lat1) * s($rad_lat2)) - (s($rad_lat1) * c($rad_lat2) * c($dLon))" | bc -l)
    atan2 $y $x
    bearing=$(echo "scale=10; $DEG_PER_RAD * $a2" | bc -l)
}

get_bearing 49.624196795 6.1256280094 49.6241653669 6.1242621755
echo "Bearing is "$bearing

PLCに関しては経験がないのでお力になれません。ごめん

于 2014-04-10T17:56:12.350 に答える