计算方位时要有倾角和长度，但不能有ATAN2功能

Question

我一直在网上搜索，试图找到一种不使用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]

基因

Answer 1

你的方程没问题。下面是在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，我没有经验，所以我不能帮助你。抱歉