Mirror/ardupilot
5
0
Fork 0
mirror of https://github.com/ArduPilot/ardupilot synced 2025-03-11 17:13:56 -03:00
Code Issues Packages Projects Releases Wiki Activity

AP_Scripting: mount-poi displays startup message

Browse Source 
Also remove out-of-date-comments
This commit is contained in:
Randy Mackay 2023-11-03 12:56:18 +09:00 committed by Andrew Tridgell
parent 3bface980d
commit ff3925a0fd
1 changed files with 5 additions and 4 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

9
libraries/AP_Scripting/applets/mount-poi.lua
View File

@ -157,6 +157,7 @@ function interpolate(low_output, high_output, var_value, var_low, var_high)
return (low_output + p * (high_output - low_output))
end
gcs:send_text(MAV_SEVERITY.INFO, "Mount-poi script started")
-- the main update function called at 10hz
function update()
@ -181,7 +182,7 @@ function update()
-- retrieve vehicle location
local vehicle_loc = ahrs:get_location()
if vehicle_loc == nil then
gcs:send_text(MAV_SEVERITY.ERROR, "POI: vehicle pos unavailable") -- MAV_SEVERITY_ERROR
gcs:send_text(MAV_SEVERITY.ERROR, "POI: vehicle pos unavailable")
return update, UPDATE_INTERVAL_MS
end
@ -191,7 +192,7 @@ function update()
-- retrieve gimbal attitude
local _, pitch_deg, yaw_bf_deg = mount:get_attitude_euler(0)
if pitch_deg == nil or yaw_bf_deg == nil then
gcs:send_text(MAV_SEVERITY.ERROR, "POI: gimbal attitude unavailable") -- MAV_SEVERITY_ERROR
gcs:send_text(MAV_SEVERITY.ERROR, "POI: gimbal attitude unavailable")
return update, UPDATE_INTERVAL_MS
end
@ -206,7 +207,7 @@ function update()
-- fail if terrain alt cannot be retrieved
if terrain_amsl_m == nil then
gcs:send_text(MAV_SEVERITY.ERROR, "POI: failed to get terrain alt") -- MAV_SEVERITY_ERROR
gcs:send_text(MAV_SEVERITY.ERROR, "POI: failed to get terrain alt")
return update, UPDATE_INTERVAL_MS
end
@ -235,7 +236,7 @@ function update()
-- fail if terrain alt cannot be retrieved
if terrain_amsl_m == nil then
gcs:send_text(MAV_SEVERITY.ERROR, "POI: failed to get terrain alt") -- MAV_SEVERITY_ERROR
gcs:send_text(MAV_SEVERITY.ERROR, "POI: failed to get terrain alt")
return update, UPDATE_INTERVAL_MS
end
end