Nu ik het mixerscript af heb wil ik ook jouw advies verder opvolgen en ben dus aan het kijken naar je voorbeeld om bidirectionele communicatie voor elkaar te krijgen tussen een LUA script en een eigengemaakte S-port sensor.
#include <SPort.h> //Include the SPort library
SPortHub hub(0x12, 3); //Hardware ID 0x12, Software serial pin 3
SimpleSPortSensor sensor(0x5900); //Sensor with ID 0x5900
void setup() {
hub.commandId = 0x1B; //Listen to data send to thist physical ID
hub.commandReceived = handleCommand; //Function to handle received commands
hub.registerSensor(sensor); //Add sensor to the hub
hub.begin(); //Start listening
}
void loop() {
sensor.value = 1234; //Set the sensor value
hub.handle(); //Handle new data
}
void handleCommand(int prim, int applicationId, int value) {
hub.sendCommand(0x32, applicationId, value + 1); //Send a command back to lua, with 0x32 as reply and the value + 1
}
/*
This sketch emulates 20 different sensor parameters based on below FRsky sensor table
It is using Tadango's s.Port library at: https://github.com/RealTadango/FrSky
May 2021: V1 by Hans Meijdam
to-do: Find and add the formula's for "flvss_cells" en "gps_date_time" application ID's.
Sensor class | Physical ID | Application ID | #define | Data type | Poll time [ms]
------------------------+--------------+----------------+-----------------------+----------------------+-----------------
FrSkySportSensorAss | ID10 | 0x0A00 | ASS_SPEED_DATA_ID | air speed | 500
------------------------+--------------+----------------+-----------------------+----------------------+-----------------
FrSkySportSensorEsc | ID17 | 0x0B50 | ESC_POWER_DATA_ID | ESC voltage/current | 300
| | 0x0B60 | ESC_RPM_CONS_DATA_ID | RPM/consumption | 300
| | 0x0B70 | ESC_TEMP_DATA_ID | temperature | 300
| | 0x0E50 | ESC_SBEC_DATA_ID | SBEC voltage/current | 300
------------------------+--------------+----------------+-----------------------+----------------------+-----------------
FrSkySportSensorFcs | ID3 | 0x0200 | FCS_CURR_DATA_ID | current | 500
| | 0x0210 | FCS_VOLT_DATA_ID | voltage | 500
------------------------+--------------+----------------+-----------------------+----------------------+-----------------
FrSkySportSensotFlvss | ID2 | 0x0300 | FLVSS_CELL_DATA_ID | cell voltage | 300
------------------------+--------------+----------------+-----------------------+----------------------+-----------------
FrskySportSensorGps | ID4 | 0x0800 | GPS_LAT_LON_DATA_ID | latitude/longitude | 1000
| | 0x0820 | GPS_ALT_DATA_ID | altitude | 500
| | 0x0830 | GPS_SPEED_DATA_ID | ground speed | 500
| | 0x0840 | GPS_COG_DATA_ID | COG | 500
| | 0x0850 | GPS_DATE_TIME_DATA_ID | date/time | 10000
------------------------+--------------+----------------+-----------------------+----------------------+-----------------
FrskySportSensorRpm | ID5 | 0x0400 | RPM_T1_DATA_ID | temperature 1 | 1000
| | 0x0410 | RPM_T2_DATA_ID | temperature 2 | 1000
| | 0x0500 | RPM_ROT_DATA_ID | RPM | 500
------------------------+--------------+----------------+-----------------------+----------------------+-----------------
FrSkySportSensorSp2uart | ID7 | 0x0900 | SP2UARTB_ADC3_DATA_ID | ADC 3 | 500
| | 0x0910 | SP2UARTB_ADC4_DATA_ID | ADC 4 | 500
------------------------+--------------+----------------+-----------------------+----------------------+-----------------
FrskySportSensorVario | ID1 | 0x0100 | VARIO_ALT_DATA_ID | altitude | 200
| | 0x0110 | VARIO_VSI_DATA_ID | VSI | 100
*/
#include <SPort.h> // Include the SPort library
SPortHub hub(0x12, 2); // Hardware ID 0x12, Software serial pin 2
SimpleSPortSensor vario_alt(0x0100); // Vario Altitude
SimpleSPortSensor vario_vsi(0x0110); // Vario vertical speed
SimpleSPortSensor fcs_current(0x0200); // FCS current (0x200 - 0x020f)
SimpleSPortSensor fcs_voltage(0x0210); // FCS voltage (0x210 - 0x021f)
SimpleSPortSensor flvss_cells(0x0300); // FLvss cell voltage
SimpleSPortSensor rpm_temp1(0x0400); // RPM temperature 1
SimpleSPortSensor rpm_temp2(0x0410); // RPM temperature 2
SimpleSPortSensor rpm_rotation(0x0500); // RPM rotations per minute
SimpleSPortSensor gps_lat_lon(0x0800); // GPS latitude / longitude
SimpleSPortSensor gps_alt(0x0820); // GPS altitude
SimpleSPortSensor gps_speed(0x0830); // GPS speed
SimpleSPortSensor gps_cog(0x0840); // GPS course over ground
SimpleSPortSensor gps_date_time(0x0850); // GPS date / time
SimpleSPortSensor sp2uart_adc3(0x0900); // UART ADC 3
SimpleSPortSensor sp2uart_adc4(0x0910); // UART ADC 4
SimpleSPortSensor ass_airspeed(0x0A00); // ASS airspeed
SimpleSPortSensor esc_power(0x0B50); // ESC power
SimpleSPortSensor esc_rpm(0x0B60); // ESC Rotations per minute
SimpleSPortSensor esc_temp(0x0B70); // ESC temperature
SimpleSPortSensor esc_sbec(0x0E50); // ESC SBEC voltage / current
long alt = 0;
byte sendlat = 0;
long longitude = 000000000;
long latitude = 000000000;
void setup() {
pinMode (13, OUTPUT);
hub.registerSensor(vario_alt); //Add sensor to the hub
hub.registerSensor(vario_vsi); //Add sensor to the hub
hub.registerSensor(fcs_current); //Add sensor to the hub
hub.registerSensor(fcs_voltage); //Add sensor to the hub
hub.registerSensor(flvss_cells); //Add sensor to the hub
hub.registerSensor(rpm_temp1); //Add sensor to the hub
hub.registerSensor(rpm_temp2); //Add sensor to the hub
hub.registerSensor(rpm_rotation); //Add sensor to the hub
hub.registerSensor(gps_lat_lon); //Add sensor to the hub
hub.registerSensor(gps_alt); //Add sensor to the hub
hub.registerSensor(gps_speed); //Add sensor to the hub
hub.registerSensor(gps_cog); //Add sensor to the hub
hub.registerSensor(gps_date_time); //Add sensor to the hub
hub.registerSensor(sp2uart_adc3); //Add sensor to the hub
hub.registerSensor(sp2uart_adc4); //Add sensor to the hub
hub.registerSensor(ass_airspeed); //Add sensor to the hub
hub.registerSensor(esc_power); //Add sensor to the hub
hub.registerSensor(esc_rpm); //Add sensor to the hub
hub.registerSensor(esc_temp); //Add sensor to the hub
hub.registerSensor(esc_sbec); //Add sensor to the hub
hub.begin(); //Start listening
}
void loop() {
vario_alt.value = 12345; //in cm / default is auto zero offset
vario_vsi.value = 1234; //in cm per second
fcs_current.value = 1234; //in 0.1 Amps
fcs_voltage.value = 1234; //in 0.01 volts
flvss_cells.value = 0; //????? to-do (unknown formatting)
rpm_temp1.value = 123; //in degrees celcius
rpm_temp2.value = 123; //in degrees celcius
rpm_rotation.value = 123; //in revolutions per minute
if (sendlat == 0){ // GPS longitude and latitude is send in an alternating sequence one after the other.
gps_lat_lon.value = (( ((((uint32_t)( longitude < 0 ? -longitude : longitude)) /10 ) * 6 ) / 10 ) & 0x3FFFFFFF) | 0x80000000;
if (longitude < 0) gps_lat_lon.value |= 0x40000000;
sendlat = 1;
longitude = longitude - 1000;
}
else { // The same field gps_lat_lon.value is used for both lat and lon.
gps_lat_lon.value = (( ((((uint32_t)( latitude < 0 ? -latitude : latitude)) / 10 ) * 6 )/ 10 ) & 0x3FFFFFFF ) ;
if (latitude < 0) gps_lat_lon.value |= 0x40000000;
sendlat = 0;
latitude = latitude + 1000;
}
digitalWrite(13, sendlat); // Led will toggle when GPS latitude or longitude is sent
gps_alt.value = alt = alt+1; //in cm but per 10cm displayed
gps_speed.value = 100000; //in 0.001 kts
gps_cog.value = 12345; //in 0.01 degrees
gps_date_time.value = 0; // ????? to-do difficult to understand formula/mechanism
sp2uart_adc3.value = 1234; //in 0.01 Volt
sp2uart_adc4.value = 1234; //in 0.01 Volt
ass_airspeed.value = 1000; //in 0.1 kts
uint32_t volt = 1200; //ESC Volts in 0.01 Volts
uint32_t curr = 3400; //ESC Ampere in 0.01 Ampere
uint32_t powerData = (((uint32_t)round(curr * 100)) << 16) + (uint32_t)round(volt * 100); // for whole volts input
// uint32_t powerData = (curr << 16) + volt;
esc_power.value = powerData; //Set the sensor value
uint32_t rpm = 9000; //ESC RPM in Rotations Per Minute
uint32_t cons = 3210; //ESC consumption in MAh utilized
uint32_t rpmConsData = (cons << 16) + (rpm / 100);
esc_rpm.value = rpmConsData; //Set the sensor value
esc_temp.value = 123; //in degrees Celcius
uint32_t sbecCurr = 7500; //in milliAmpere
uint32_t sbecVolt = 5432; //in milliVolt
uint32_t sbecData = (((uint32_t)round(sbecCurr * 1000)) << 16) + (uint32_t)round(sbecVolt * 1000); // for whole values
// uint32_t sbecData = (sbecCurr << 16) + sbecVolt;
esc_sbec.value = sbecData; //Set the sensor value
hub.handle(); //Handle new data
}
