From f414d91536107793cf776338650d6c8d7cbded80 Mon Sep 17 00:00:00 2001 From: zisi Date: Mon, 8 Oct 2018 15:58:38 +0300 Subject: [PATCH] Resolve issue with AZ EL command Signed-off-by: zisi --- libraries/easycomm.h | 8 ++++++++ 1 file changed, 8 insertions(+) diff --git a/libraries/easycomm.h b/libraries/easycomm.h index cf21aa3..a4ebf0f 100644 --- a/libraries/easycomm.h +++ b/libraries/easycomm.h @@ -79,6 +79,14 @@ public: if (isNumber(data)) { control_az.setpoint = atof(data); } + // Get the absolute position in deg for elevation + rawData = strtok_r(Data, " ", &Data); + if (rawData[0] == 'E' && rawData[1] == 'L') { + strncpy(data, rawData + 2, 10); + if (isNumber(data)) { + control_el.setpoint = atof(data); + } + } } } else if (buffer[0] == 'E' && buffer[1] == 'L') { // Get the absolute position in deg for elevation