Hamlib/rotators/apex/sharedloop.c

100 wiersze
2.2 KiB
C

/* Apex Shared Loop Controller */
#include <math.h>
#include "hamlib/rotator.h"
#include "iofunc.h"
#include "apex.h"
int apex_shared_loop_get_position(ROT *rot, float *az, float *el)
{
int loop = 10;
while (--loop > 0 && apex_azimuth < 0)
{
hl_usleep(250 * 1000);
};
*az = apex_azimuth;
*el = 0;
return RIG_OK;
}
int apex_shared_loop_set_position(ROT *rot, float az, float dummy)
{
char cmdstr[16];
int retval;
hamlib_port_t *rotp = ROTPORT(rot);
int remainder = lround(az + 22.5) % 45;
int apex_az = lround(az + 22.5) - remainder;
// default to 0 degrees
snprintf(cmdstr, sizeof(cmdstr), "[R99T4AM10]\r\n");
switch (apex_az)
{
case 45: cmdstr[9] = '1'; break;
case 90: cmdstr[9] = '2'; break;
case 135: cmdstr[9] = '3'; break;
case 180: cmdstr[9] = '4'; break;
case 225: cmdstr[9] = '5'; break;
case 270: cmdstr[9] = '6'; break;
case 315: cmdstr[9] = '7'; break;
default:
rig_debug(RIG_DEBUG_ERR, "%s: unknown az=%d\n", __func__, apex_az);
return -RIG_EINTERNAL;
}
rig_flush(rotp);
apex_azimuth = -1;
retval = write_block(rotp, (unsigned char *) cmdstr, strlen(cmdstr));
if (retval != RIG_OK)
{
rig_debug(RIG_DEBUG_ERR, "%s: write_block error - %s\n", __func__,
rigerror(retval));
return retval;
}
return RIG_OK;
}
const struct rot_caps apex_shared_loop_rot_caps =
{
ROT_MODEL(ROT_MODEL_APEX_SHARED_LOOP),
.model_name = "Shared Loop",
.mfg_name = "Apex",
.version = "20231013.0",
.copyright = "LGPL",
.status = RIG_STATUS_STABLE,
.rot_type = ROT_TYPE_AZIMUTH,
.port_type = RIG_PORT_SERIAL,
.serial_rate_min = 57600,
.serial_rate_max = 57600,
.serial_data_bits = 8,
.serial_stop_bits = 1,
.serial_parity = RIG_PARITY_NONE,
.serial_handshake = RIG_HANDSHAKE_NONE,
.write_delay = 0,
.post_write_delay = 0,
.timeout = 4000,
.retry = 2,
.min_az = 0.0,
.max_az = 360.0,
.rot_open = apex_open,
.get_info = apex_get_info,
.get_position = apex_shared_loop_get_position,
.set_position = apex_shared_loop_set_position,
};