|
|
#**********************计算Yrtcp*********************
set e1 [expr -1.0*sin($rad_c)]
set e2 [expr cos($rad_c)-1.0]
set d1 [expr round($e1*1000000.0)/1000000.0]
set d2 [expr round($e2*1000000.0)/1000000.0]
set vy [expr round($mom_pos(1)*10000.0)/10000.0]
set w1 [format "%.6f" $d1]
if {![string compare "-1.000000" $w1]} {
set s1 "-#101"
} elseif {![string compare "1.000000" $w1]} {
set s1 "#101"
} else {
if {[string index $w1 end-0] == "0"} {
if {[string index $w1 end-1] == "0"} {
if {[string index $w1 end-2] == "0"} {
if {[string index $w1 end-3] == "0"} {
if {[string index $w1 end-4] == "0"} {
if {[string index $w1 end-5] == "0"} {
set w1 [format "%d." [expr round($d1)]]
} else {
set w1 [format "%.1f" $d1]
}
} else {
set w1 [format "%.2f" $d1]
}
} else {
set w1 [format "%.3f" $d1]
}
} else {
set w1 [format "%.4f" $d1]
}
} else {
set w1 [format "%.5f" $d1]
}
}
if {$d1 != 0.0} {
set s1 [format "%s*#101" $w1]
} else {
set s1 "NONE"
}
}
set w2 [format "%.6f" $d2]
if {![string compare "-1.000000" $w2]} {
set s2 "-#102"
} elseif {![string compare "1.000000" $w2]} {
set s2 "+#102"
} else {
if {[string index $w2 end-0] == "0"} {
if {[string index $w2 end-1] == "0"} {
if {[string index $w2 end-2] == "0"} {
if {[string index $w2 end-3] == "0"} {
if {[string index $w2 end-4] == "0"} {
if {[string index $w2 end-5] == "0"} {
set w2 [format "%d." [expr round($d2)]]
} else {
set w2 [format "%.1f" $d2]
}
} else {
set w2 [format "%.2f" $d2]
}
} else {
set w2 [format "%.3f" $d2]
}
} else {
set w2 [format "%.4f" $d2]
}
} else {
set w2 [format "%.5f" $d2]
}
}
if {$d2 > 0.0} {
set s2 [format "+%s*#102" $w2]
} elseif {$d2 < 0.0} {
set s2 [format "%s*#102" $w2]
} else {
set s2 "NONE"
}
}
set w4 [format "%.4f" $vy]
if {[string index $w4 end-0] == "0"} {
if {[string index $w4 end-1] == "0"} {
if {[string index $w4 end-2] == "0"} {
if {[string index $w4 end-3] == "0"} {
set w4 [format "%d." [expr round($vy)]]
} else {
set w4 [format "%.1f" $vy]
}
} else {
set w4 [format "%.2f" $vy]
}
} else {
set w4 [format "%.3f" $vy]
}
}
if {$vy > 0.0} {
set s4 [format "+%s" $w4]
} elseif {$vy < 0.0} {
set s4 [format "%s" $w4]
} else {
set s4 "NONE"
}
if {[string compare "NONE" $s1] && ![string compare "NONE" $s2]} {
set s $s1
} elseif {![string compare "NONE" $s1] && [string compare "NONE" $s2]} {
set s $s2
} elseif {[string compare "NONE" $s1] && [string compare "NONE" $s2]} {
set s [format "%s%s" $s1 $s2]
} else {
set s "NONE"
}
if {[string compare "NONE" $s] && [string compare "NONE" $s4]} {
set sy [format "\[%s%s\]" $s $s4]
} elseif {![string compare "NONE" $s] && [string compare "NONE" $s4]} {
set sy $s4
} elseif {[string compare "NONE" $s] && ![string compare "NONE" $s4]} {
set sy [format "\[%s\]" $s]
} else {
set sy "0."
}
#**********************计算Zrtcp*********************
set e1 [expr cos($rad_b)-1.0]
set e2 [expr sin($rad_b)*cos($rad_c)]
set e3 [expr sin($rad_b)*sin($rad_c)]
set d1 [expr round($e1*1000000.0)/1000000.0]
set d2 [expr round($e2*1000000.0)/1000000.0]
set d3 [expr round($e3*1000000.0)/1000000.0]
set vz [expr round($mom_pos(2)*10000.0)/10000.0]
set w1 [format "%.6f" $d1]
if {![string compare "-1.000000" $w1]} {
set s1 "-#103"
} elseif {![string compare "1.000000" $w1]} {
set s1 "#103"
} else {
if {[string index $w1 end-0] == "0"} {
if {[string index $w1 end-1] == "0"} {
if {[string index $w1 end-2] == "0"} {
if {[string index $w1 end-3] == "0"} {
if {[string index $w1 end-4] == "0"} {
if {[string index $w1 end-5] == "0"} {
set w1 [format "%d." [expr round($d1)]]
} else {
set w1 [format "%.1f" $d1]
}
} else {
set w1 [format "%.2f" $d1]
}
} else {
set w1 [format "%.3f" $d1]
}
} else {
set w1 [format "%.4f" $d1]
}
} else {
set w1 [format "%.5f" $d1]
}
}
if {$d1 != 0.0} {
set s1 [format "%s*#103" $w1]
} else {
set s1 "NONE"
}
}
set w2 [format "%.6f" $d2]
if {![string compare "-1.000000" $w2]} {
set s2 "-#101"
} elseif {![string compare "1.000000" $w2]} {
set s2 "+#101"
} else {
if {[string index $w2 end-0] == "0"} {
if {[string index $w2 end-1] == "0"} {
if {[string index $w2 end-2] == "0"} {
if {[string index $w2 end-3] == "0"} {
if {[string index $w2 end-4] == "0"} {
if {[string index $w2 end-5] == "0"} {
set w2 [format "%d." [expr round($d2)]]
} else {
set w2 [format "%.1f" $d2]
}
} else {
set w2 [format "%.2f" $d2]
}
} else {
set w2 [format "%.3f" $d2]
}
} else {
set w2 [format "%.4f" $d2]
}
} else {
set w2 [format "%.5f" $d2]
}
}
if {$d2 > 0.0} {
set s2 [format "+%s*#101" $w2]
} elseif {$d2 < 0.0} {
set s2 [format "%s*#101" $w2]
} else {
set s2 "NONE"
}
}
未完待续。。。。
|
|
发表于