Add const strings for comma and new line
Also remove the unnecessary new line from return pacakges Signed-off-by: Agis Zisimatos <agzisim@gmail.com>merge-requests/7/head
parent
ccff364701
commit
0b6a5daf90
|
@ -52,7 +52,9 @@ public:
|
|||
char *rawData;
|
||||
static uint16_t BufferCnt = 0;
|
||||
char data[100];
|
||||
String str1, str2, str3, str4, str5, str6;
|
||||
String str1, str2, str3, str4, str5, str_comma, str_newline;
|
||||
str_comma = String(",");
|
||||
str_newline = String("\n");
|
||||
|
||||
// Read from serial
|
||||
while (rs485.available() > 0) {
|
||||
|
@ -69,8 +71,7 @@ public:
|
|||
str2 = String(control_az.input, 1);
|
||||
str3 = String(" EL");
|
||||
str4 = String(control_el.input, 1);
|
||||
str5 = String("\n");
|
||||
rs485.print(str1 + str2 + str3 + str4 + str5);
|
||||
rs485.print(str1 + str2 + str3 + str4 + str_newline);
|
||||
} else {
|
||||
// Get the absolute position in deg for azimuth
|
||||
rotator.control_mode = position;
|
||||
|
@ -171,8 +172,7 @@ public:
|
|||
str2 = String(control_az.input, 1);
|
||||
str3 = String(" EL");
|
||||
str4 = String(control_el.input, 1);
|
||||
str5 = String("\n");
|
||||
rs485.print(str1 + str2 + str3 + str4 + str5);
|
||||
rs485.print(str1 + str2 + str3 + str4 + str_newline);
|
||||
control_az.setpoint = control_az.input;
|
||||
control_el.setpoint = control_el.input;
|
||||
} else if (buffer[0] == 'R' && buffer[1] == 'E' &&
|
||||
|
@ -183,8 +183,7 @@ public:
|
|||
str2 = String(control_az.input, 1);
|
||||
str3 = String(" EL");
|
||||
str4 = String(control_el.input, 1);
|
||||
str5 = String("\n");
|
||||
rs485.print(str1 + str2 + str3 + str4 + str5);
|
||||
rs485.print(str1 + str2 + str3 + str4 + str_newline);
|
||||
rotator.homing_flag = false;
|
||||
} else if (buffer[0] == 'P' && buffer[1] == 'A' &&
|
||||
buffer[2] == 'R' && buffer[3] == 'K' ) {
|
||||
|
@ -194,72 +193,62 @@ public:
|
|||
str2 = String(control_az.input, 1);
|
||||
str3 = String(" EL");
|
||||
str4 = String(control_el.input, 1);
|
||||
str5 = String("\n");
|
||||
rs485.print(str1 + str2 + str3 + str4 + str5);
|
||||
rs485.print(str1 + str2 + str3 + str4 + str_newline);
|
||||
control_az.setpoint = rotator.park_az;
|
||||
control_el.setpoint = rotator.park_el;
|
||||
} else if (buffer[0] == 'V' && buffer[1] == 'E') {
|
||||
// Get the version if rotator controller
|
||||
str1 = String("VE");
|
||||
str2 = String("SatNOGS-v2.2");
|
||||
str3 = String("\n");
|
||||
rs485.print(str1 + str2 + str3);
|
||||
rs485.print(str1 + str2);
|
||||
} else if (buffer[0] == 'I' && buffer[1] == 'P' &&
|
||||
buffer[2] == '0') {
|
||||
// Get the inside temperature
|
||||
str1 = String("IP0,");
|
||||
str2 = String(rotator.inside_temperature, DEC);
|
||||
str3 = String("\n");
|
||||
rs485.print(str1 + str2 + str3);
|
||||
rs485.print(str1 + str2 + str_newline);
|
||||
} else if (buffer[0] == 'I' && buffer[1] == 'P' &&
|
||||
buffer[2] == '1') {
|
||||
// Get the status of end-stop, azimuth
|
||||
str1 = String("IP1,");
|
||||
str2 = String(rotator.switch_az, DEC);
|
||||
str3 = String("\n");
|
||||
rs485.print(str1 + str2 + str3);
|
||||
rs485.print(str1 + str2 + str_newline);
|
||||
} else if (buffer[0] == 'I' && buffer[1] == 'P' &&
|
||||
buffer[2] == '2') {
|
||||
// Get the status of end-stop, elevation
|
||||
str1 = String("IP2,");
|
||||
str2 = String(rotator.switch_el, DEC);
|
||||
str3 = String("\n");
|
||||
rs485.print(str1 + str2 + str3);
|
||||
rs485.print(str1 + str2 + str_newline);
|
||||
} else if (buffer[0] == 'I' && buffer[1] == 'P' &&
|
||||
buffer[2] == '3') {
|
||||
// Get the current position of azimuth in deg
|
||||
str1 = String("IP3,");
|
||||
str2 = String(control_az.input, 2);
|
||||
str3 = String("\n");
|
||||
rs485.print(str1 + str2 + str3);
|
||||
rs485.print(str1 + str2 + str_newline);
|
||||
} else if (buffer[0] == 'I' && buffer[1] == 'P' &&
|
||||
buffer[2] == '4') {
|
||||
// Get the current position of elevation in deg
|
||||
str1 = String("IP4,");
|
||||
str2 = String(control_el.input, 2);
|
||||
str3 = String("\n");
|
||||
rs485.print(str1 + str2 + str3);
|
||||
rs485.print(str1 + str2 + str_newline);
|
||||
} else if (buffer[0] == 'I' && buffer[1] == 'P' &&
|
||||
buffer[2] == '5') {
|
||||
// Get the load of azimuth, in range of 0-1023
|
||||
str1 = String("IP5,");
|
||||
str2 = String(control_az.load, DEC);
|
||||
str3 = String("\n");
|
||||
rs485.print(str1 + str2 + str3);
|
||||
rs485.print(str1 + str2 + str_newline);
|
||||
} else if (buffer[0] == 'I' && buffer[1] == 'P' &&
|
||||
buffer[2] == '6') {
|
||||
// Get the load of elevation, in range of 0-1023
|
||||
str1 = String("IP6,");
|
||||
str2 = String(control_el.load, DEC);
|
||||
str3 = String("\n");
|
||||
rs485.print(str1 + str2 + str3);
|
||||
rs485.print(str1 + str2 + str_newline);
|
||||
} else if (buffer[0] == 'I' && buffer[1] == 'P' &&
|
||||
buffer[2] == '7') {
|
||||
// Get the speed of azimuth in deg/s
|
||||
str1 = String("IP7,");
|
||||
str2 = String(control_az.speed, 2);
|
||||
str3 = String("\n");
|
||||
rs485.print(str1 + str2 + str3);
|
||||
rs485.print(str1 + str2 + str_newline);
|
||||
} else if (buffer[0] == 'I' && buffer[1] == 'P' &&
|
||||
buffer[2] == '8') {
|
||||
// Get the speed of elevation in deg/s
|
||||
|
@ -279,70 +268,59 @@ public:
|
|||
// Get the status of rotator
|
||||
str1 = String("GS");
|
||||
str2 = String(rotator.rotator_status, DEC);
|
||||
str3 = String("\n");
|
||||
rs485.print(str1 + str2 + str3);
|
||||
rs485.print(str1 + str2);
|
||||
} else if (buffer[0] == 'G' && buffer[1] == 'E') {
|
||||
// Get the error of rotator
|
||||
str1 = String("GE");
|
||||
str2 = String(rotator.rotator_error, DEC);
|
||||
str3 = String("\n");
|
||||
rs485.print(str1 + str2 + str3);
|
||||
rs485.print(str1 + str2);
|
||||
} else if(buffer[0] == 'C' && buffer[1] == 'R') {
|
||||
// Get Configuration of rotator
|
||||
if (buffer[3] == '1') {
|
||||
// Get Kp Azimuth gain
|
||||
str1 = String("1,");
|
||||
str2 = String(control_az.p, 2);
|
||||
str3 = String("\n");
|
||||
rs485.print(str1 + str2 + str3);
|
||||
rs485.print(str1 + str2);
|
||||
} else if (buffer[3] == '2') {
|
||||
// Get Ki Azimuth gain
|
||||
str1 = String("2,");
|
||||
str2 = String(control_az.i, 2);
|
||||
str3 = String("\n");
|
||||
rs485.print(str1 + str2 + str3);
|
||||
str2 = String(control_az.i, 2);
|
||||
rs485.print(str1 + str2);
|
||||
} else if (buffer[3] == '3') {
|
||||
// Get Kd Azimuth gain
|
||||
str1 = String("3,");
|
||||
str2 = String(control_az.d, 2);
|
||||
str3 = String("\n");
|
||||
rs485.print(str1 + str2 + str3);
|
||||
rs485.print(str1 + str2);
|
||||
} else if (buffer[3] == '4') {
|
||||
// Get Kp Elevation gain
|
||||
str1 = String("4,");
|
||||
str2 = String(control_el.p, 2);
|
||||
str3 = String("\n");
|
||||
rs485.print(str1 + str2 + str3);
|
||||
str2 = String(control_el.p, 2);
|
||||
rs485.print(str1 + str2);
|
||||
} else if (buffer[3] == '5') {
|
||||
// Get Ki Elevation gain
|
||||
str1 = String("5,");
|
||||
str2 = String(control_el.i, 2);
|
||||
str3 = String("\n");
|
||||
rs485.print(str1 + str2 + str3);
|
||||
rs485.print(str1 + str2);
|
||||
} else if (buffer[3] == '6') {
|
||||
// Get Kd Elevation gain
|
||||
str1 = String("6,");
|
||||
str2 = String(control_el.d, 2);
|
||||
str3 = String("\n");
|
||||
rs485.print(str1 + str2 + str3);
|
||||
rs485.print(str1 + str2);
|
||||
} else if (buffer[3] == '7') {
|
||||
// Get Azimuth park position
|
||||
str1 = String("7,");
|
||||
str2 = String(rotator.park_az, 2);
|
||||
str3 = String("\n");
|
||||
rs485.print(str1 + str2 + str3);
|
||||
rs485.print(str1 + str2);
|
||||
} else if (buffer[3] == '8') {
|
||||
// Get Elevation park position
|
||||
str1 = String("8,");
|
||||
str2 = String(rotator.park_el, 2);
|
||||
str3 = String("\n");
|
||||
rs485.print(str1 + str2 + str3);
|
||||
rs485.print(str1 + str2);
|
||||
} else if (buffer[3] == '9') {
|
||||
// Get control mode
|
||||
str1 = String("9,");
|
||||
str2 = String(rotator.control_mode);
|
||||
str3 = String("\n");
|
||||
rs485.print(str1 + str2 + str3);
|
||||
rs485.print(str1 + str2);
|
||||
}
|
||||
} else if (buffer[0] == 'C' && buffer[1] == 'W') {
|
||||
// Set Config
|
||||
|
|
Loading…
Reference in New Issue