kopia lustrzana https://github.com/Hamlib/Hamlib
439 wiersze
9.4 KiB
C
439 wiersze
9.4 KiB
C
/*
|
|
* Hamlib Ether6 backend - main file
|
|
* Copyright (c) 2001-2009 by Stephane Fillod
|
|
* Copyright (c) 2013 by Jonny Röker <Jonny.Roeker@t-online.de>
|
|
*
|
|
*
|
|
* This library is free software; you can redistribute it and/or
|
|
* modify it under the terms of the GNU Lesser General Public
|
|
* License as published by the Free Software Foundation; either
|
|
* version 2.1 of the License, or (at your option) any later version.
|
|
*
|
|
* This library is distributed in the hope that it will be useful,
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
|
|
* Lesser General Public License for more details.
|
|
*
|
|
* You should have received a copy of the GNU Lesser General Public
|
|
* License along with this library; if not, write to the Free Software
|
|
* Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
|
|
*
|
|
*/
|
|
|
|
#include <stdio.h>
|
|
#include <stdlib.h>
|
|
#include <string.h> /* String function definitions */
|
|
|
|
#include <hamlib/rotator.h>
|
|
#include "serial.h"
|
|
#include "register.h"
|
|
#include "idx_builtin.h"
|
|
|
|
#include "ether6.h"
|
|
|
|
#define CMD_MAX 32
|
|
#define BUF_MAX 64
|
|
|
|
#define ETHER_LEVELS ROT_LEVEL_SPEED
|
|
|
|
/*
|
|
* Helper function with protocol return code parsing
|
|
*/
|
|
static int ether_transaction(ROT *rot, char *cmd, int len, char *buf)
|
|
{
|
|
int ret;
|
|
hamlib_port_t *rotp = ROTPORT(rot);
|
|
|
|
ret = write_block(rotp, (unsigned char *) cmd, len);
|
|
rig_debug(RIG_DEBUG_VERBOSE, "function %s(1): ret=%d || send=%s\n", __func__,
|
|
ret, cmd);
|
|
|
|
if (ret != RIG_OK)
|
|
{
|
|
return ret;
|
|
}
|
|
|
|
ret = read_string(rotp, (unsigned char *) buf, BUF_MAX,
|
|
"\n", sizeof("\n"), 0, 1);
|
|
rig_debug(RIG_DEBUG_VERBOSE, "function %s(2): ret=%d || receive=%s\n", __func__,
|
|
ret, buf);
|
|
|
|
if (ret < 0)
|
|
{
|
|
return ret;
|
|
}
|
|
|
|
if (!memcmp(buf, ROTORCTL_RET, strlen(ROTORCTL_RET)))
|
|
{
|
|
rig_debug(RIG_DEBUG_VERBOSE, "function %s(2a): receive=%s\n", __func__, buf);
|
|
return RIG_OK;
|
|
}
|
|
|
|
if (!memcmp(buf, NETROTCTL_RET, strlen(NETROTCTL_RET)))
|
|
{
|
|
int rv = atoi(buf + strlen(NETROTCTL_RET));
|
|
rig_debug(RIG_DEBUG_VERBOSE, "function %s(2): ret=%d || receive=%d\n", __func__,
|
|
ret, rv);
|
|
return atoi(buf + strlen(NETROTCTL_RET));
|
|
}
|
|
|
|
return ret;
|
|
}
|
|
|
|
static int ether_rot_open(ROT *rot)
|
|
{
|
|
int ret;
|
|
int sval;
|
|
float min_az, max_az, min_el, max_el;
|
|
struct rot_state *rs = &rot->state;
|
|
|
|
char cmd[CMD_MAX];
|
|
char buf[BUF_MAX];
|
|
|
|
rig_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
|
|
/* elevation not need */
|
|
|
|
SNPRINTF(cmd, sizeof(cmd), "rotor state\n");
|
|
/*-180/180 0/90*/
|
|
|
|
ret = ether_transaction(rot, cmd, strlen(cmd), buf);
|
|
|
|
if (ret <= 0)
|
|
{
|
|
return (ret < 0) ? ret : -RIG_EPROTO;
|
|
}
|
|
|
|
sval = sscanf(buf, "%f/%f %f/%f", &min_az, &max_az, &min_el, &max_el);
|
|
rs->min_az = min_az;
|
|
rs->max_az = max_az;
|
|
rs->min_el = min_el;
|
|
rs->max_el = max_el;
|
|
rig_debug(RIG_DEBUG_VERBOSE, "ret(%d)%f/%f %f/%f\n", sval, rs->min_az,
|
|
rs->max_az, rs->min_el, rs->max_el);
|
|
|
|
return RIG_OK;
|
|
}
|
|
|
|
static int ether_rot_close(ROT *rot)
|
|
{
|
|
rig_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
|
|
|
|
/* clean signoff, no read back */
|
|
write_block(ROTPORT(rot), (unsigned char *) "\n", 1);
|
|
|
|
return RIG_OK;
|
|
}
|
|
|
|
static int ether_rot_set_position(ROT *rot, azimuth_t az, elevation_t el)
|
|
{
|
|
int ret;
|
|
char cmd[CMD_MAX];
|
|
char buf[BUF_MAX];
|
|
|
|
rig_debug(RIG_DEBUG_VERBOSE, "%s called: %f %f\n", __func__,
|
|
az, el);
|
|
|
|
SNPRINTF(cmd, sizeof(cmd), "rotor move %d %d\n", (int)az, (int)el);
|
|
|
|
ret = ether_transaction(rot, cmd, strlen(cmd), buf);
|
|
|
|
if (ret > 0)
|
|
{
|
|
return -RIG_EPROTO;
|
|
}
|
|
else
|
|
{
|
|
return ret;
|
|
}
|
|
}
|
|
|
|
static int ether_rot_get_position(ROT *rot, azimuth_t *az, elevation_t *el)
|
|
{
|
|
int ret, sval, speed, adv;
|
|
char cmd[CMD_MAX];
|
|
char buf[BUF_MAX];
|
|
char mv[5];
|
|
|
|
rig_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
|
|
|
|
SNPRINTF(cmd, sizeof(cmd), "rotor status\n");
|
|
|
|
ret = ether_transaction(rot, cmd, strlen(cmd), buf);
|
|
|
|
if (ret <= 0)
|
|
{
|
|
return (ret < 0) ? ret : -RIG_EPROTO;
|
|
}
|
|
|
|
// example "hold,az=87,el=0,v=8,ad0=346"
|
|
sval = sscanf(buf, "%4s az=%f el=%f v=%d ad0=%d", mv, az, el, &speed, &adv);
|
|
rig_debug(RIG_DEBUG_VERBOSE, "az=%f el=%f mv=%s ad(az)=%d\n", *az, *el, mv,
|
|
adv);
|
|
|
|
if (sval == 5)
|
|
{
|
|
return RIG_OK;
|
|
}
|
|
else
|
|
{
|
|
return -RIG_EPROTO;
|
|
}
|
|
}
|
|
|
|
/**
|
|
* stop the rotor
|
|
*/
|
|
static int ether_rot_stop(ROT *rot)
|
|
{
|
|
int ret;
|
|
char cmd[CMD_MAX];
|
|
char buf[BUF_MAX];
|
|
|
|
rig_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
|
|
|
|
SNPRINTF(cmd, sizeof(cmd), "rotor stop\n");
|
|
|
|
ret = ether_transaction(rot, cmd, strlen(cmd), buf);
|
|
|
|
if (ret > 0)
|
|
{
|
|
return -RIG_EPROTO;
|
|
}
|
|
else
|
|
{
|
|
return ret;
|
|
}
|
|
}
|
|
|
|
|
|
/**
|
|
* park the rotor
|
|
*/
|
|
static int ether_rot_park(ROT *rot)
|
|
{
|
|
int ret;
|
|
char cmd[CMD_MAX];
|
|
char buf[BUF_MAX];
|
|
|
|
rig_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
|
|
|
|
SNPRINTF(cmd, sizeof(cmd), "rotor park\n");
|
|
|
|
ret = ether_transaction(rot, cmd, strlen(cmd), buf);
|
|
|
|
if (ret > 0)
|
|
{
|
|
return -RIG_EPROTO;
|
|
}
|
|
else
|
|
{
|
|
return ret;
|
|
}
|
|
}
|
|
|
|
static int ether_rot_reset(ROT *rot, rot_reset_t reset)
|
|
{
|
|
int ret;
|
|
char cmd[CMD_MAX];
|
|
char buf[BUF_MAX];
|
|
|
|
rig_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
|
|
|
|
SNPRINTF(cmd, sizeof(cmd), "reset\n");
|
|
|
|
ret = ether_transaction(rot, cmd, strlen(cmd), buf);
|
|
|
|
if (ret > 0)
|
|
{
|
|
return -RIG_EPROTO;
|
|
}
|
|
else
|
|
{
|
|
return ret;
|
|
}
|
|
}
|
|
|
|
/**
|
|
* call rotor cw or rotor ccw
|
|
* if direction value 0 turn cw and if direction value 1 turn ccw
|
|
*/
|
|
static int ether_rot_move(ROT *rot, int direction, int speed)
|
|
{
|
|
struct rot_state *rs = &rot->state;
|
|
int ret;
|
|
char cmd[CMD_MAX];
|
|
char buf[BUF_MAX];
|
|
int ether_speed;
|
|
|
|
rig_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
|
|
|
|
if (speed == ROT_SPEED_NOCHANGE)
|
|
{
|
|
ether_speed = rs->current_speed;
|
|
}
|
|
else
|
|
{
|
|
if (speed < 1 || speed > 100)
|
|
{
|
|
rig_debug(RIG_DEBUG_ERR, "%s: Invalid speed value (1-100)! (%d)\n", __func__,
|
|
speed);
|
|
return -RIG_EINVAL;
|
|
}
|
|
|
|
rs->current_speed = speed;
|
|
ether_speed = speed;
|
|
}
|
|
|
|
if (direction == 0)
|
|
{
|
|
SNPRINTF(cmd, sizeof(cmd), "rotor cw %d\n", ether_speed);
|
|
}
|
|
else
|
|
{
|
|
SNPRINTF(cmd, sizeof(cmd), "rotor ccw %d\n", ether_speed);
|
|
}
|
|
|
|
ret = ether_transaction(rot, cmd, strlen(cmd), buf);
|
|
|
|
if (ret > 0)
|
|
{
|
|
return -RIG_EPROTO;
|
|
}
|
|
else
|
|
{
|
|
return ret;
|
|
}
|
|
}
|
|
|
|
|
|
static int ether_rot_get_level(ROT *rot, setting_t level, value_t *val)
|
|
{
|
|
const struct rot_state *rs = &rot->state;
|
|
|
|
rig_debug(RIG_DEBUG_VERBOSE, "%s called: %s\n", __func__, rot_strlevel(level));
|
|
|
|
switch (level)
|
|
{
|
|
case ROT_LEVEL_SPEED:
|
|
val->i = rs->current_speed;
|
|
break;
|
|
|
|
default:
|
|
return -RIG_ENAVAIL;
|
|
}
|
|
|
|
return RIG_OK;
|
|
}
|
|
|
|
|
|
static int ether_rot_set_level(ROT *rot, setting_t level, value_t val)
|
|
{
|
|
struct rot_state *rs = &rot->state;
|
|
|
|
rig_debug(RIG_DEBUG_VERBOSE, "%s called: %s\n", __func__, rot_strlevel(level));
|
|
|
|
switch (level)
|
|
{
|
|
case ROT_LEVEL_SPEED:
|
|
{
|
|
int speed = val.i;
|
|
|
|
if (speed < 1)
|
|
{
|
|
speed = 1;
|
|
}
|
|
else if (speed > 100)
|
|
{
|
|
speed = 100;
|
|
}
|
|
|
|
rs->current_speed = speed;
|
|
break;
|
|
}
|
|
|
|
default:
|
|
return -RIG_ENAVAIL;
|
|
}
|
|
|
|
return RIG_OK;
|
|
}
|
|
|
|
|
|
|
|
static const char *ether_rot_get_info(ROT *rot)
|
|
{
|
|
rig_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
|
|
|
|
return "ip rotator via ethersex";
|
|
}
|
|
|
|
|
|
static int ether_rot_init(ROT *rot)
|
|
{
|
|
struct rot_state *rs = &rot->state;
|
|
|
|
rig_debug(RIG_DEBUG_VERBOSE, "%s called\n", __func__);
|
|
|
|
// Set default speed to half of maximum
|
|
rs->current_speed = 00;
|
|
|
|
return RIG_OK;
|
|
}
|
|
|
|
|
|
/*
|
|
* Dummy rotator capabilities.
|
|
*/
|
|
|
|
const struct rot_caps ether6_rot_caps =
|
|
{
|
|
ROT_MODEL(ROT_MODEL_ETHER6),
|
|
.model_name = "Ether6 (via ethernet)",
|
|
.mfg_name = "DG9OAA",
|
|
.version = "20220109.0",
|
|
.copyright = "LGPL",
|
|
.status = RIG_STATUS_STABLE,
|
|
.rot_type = ROT_FLAG_AZIMUTH,
|
|
.port_type = RIG_PORT_NETWORK,
|
|
.timeout = 5000,
|
|
.retry = 3,
|
|
|
|
.min_az = 0.,
|
|
.max_az = 360,
|
|
.min_el = 0,
|
|
.max_el = 90,
|
|
|
|
.priv = NULL, /* priv */
|
|
|
|
.has_get_level = ETHER_LEVELS,
|
|
.has_set_level = ROT_LEVEL_SET(ETHER_LEVELS),
|
|
|
|
.level_gran = { [ROT_LVL_SPEED] = { .min = { .i = 0 }, .max = { .i = 9999 }, .step = { .i = 1 } } },
|
|
|
|
.rot_init = ether_rot_init,
|
|
.rot_cleanup = NULL,
|
|
|
|
.rot_open = ether_rot_open,
|
|
.rot_close = ether_rot_close,
|
|
|
|
.set_position = ether_rot_set_position,
|
|
.get_position = ether_rot_get_position,
|
|
.park = ether_rot_park,
|
|
.stop = ether_rot_stop,
|
|
.reset = ether_rot_reset,
|
|
.move = ether_rot_move,
|
|
.get_level = ether_rot_get_level,
|
|
.set_level = ether_rot_set_level,
|
|
|
|
.get_info = ether_rot_get_info,
|
|
};
|
|
|
|
DECLARE_INITROT_BACKEND(ether6)
|
|
{
|
|
rig_debug(RIG_DEBUG_VERBOSE, "%s: _init called\n", __func__);
|
|
|
|
rot_register(ðer6_rot_caps);
|
|
|
|
return RIG_OK;
|
|
}
|