send n2k message for rudder angle

This commit is contained in:
andreas 2024-03-02 18:36:58 +01:00
parent 0c94293ccb
commit ebd4a8907a
2 changed files with 9 additions and 4 deletions

View File

@ -14,6 +14,7 @@
*/
#include "GWDMS22B.h"
#include "GwApi.h"
#include "N2kMessages.h"
#define CHECK_BUS(BUS) \
@ -87,12 +88,12 @@
class GWDMS22B : public SSISensor{
uint32_t zero=2047;
int zero=2047;
public:
using SSISensor::SSISensor;
virtual bool preinit(GwApi * api){
GwLog *logger=api->getLogger();
LOG_DEBUG(GwLog::LOG,"DMS22B configured, prefix=%s, intv=%f",prefix.c_str());
LOG_DEBUG(GwLog::LOG,"DMS22B configured, prefix=%s, intv=%f",prefix.c_str(),fintv);
api->addCapability(prefix,"true");
return true;
}
@ -103,7 +104,11 @@ class GWDMS22B : public SSISensor{
if (res != ESP_OK){
LOG_DEBUG(GwLog::ERROR,"unable to measure %s: %d",prefix.c_str(),(int)res);
}
LOG_DEBUG(GwLog::LOG,"measure %s : %d",prefix.c_str(),value);
double resolved=(((int)value-zero)*360.0/mask);
LOG_DEBUG(GwLog::LOG,"measure %s : %d, resolved: %f",prefix.c_str(),value,(float)resolved);
tN2kMsg msg;
SetN2kRudder(msg,DegToRad(resolved),iid);
api->sendN2kMessage(msg);
}
#define DMS22B(PRFX,...) \
if (prefix == #PRFX) {\

View File

@ -80,7 +80,7 @@
"name": "DMS22B$izero",
"label": "DMS22B$i Zero",
"type": "number",
"default": 2,
"default": 2048,
"description": "Zero position (0...2^bits-1)",
"category": "spisensors$b",
"capabilities": {