mirror of
https://github.com/OSURoboticsClub/Rover_2017_2018.git
synced 2025-11-08 18:21:15 +00:00
34 lines
758 B
C++
34 lines
758 B
C++
#include "SBUS.h"
|
|
#include <ModbusRtu.h>
|
|
|
|
SBUS x8r(Serial3);
|
|
|
|
const char num_modbus_channels = 16; //Being explicit so I get errors if I try to do something stupid
|
|
uint16_t modbus_data[num_modbus_channels] = {0, 0, 0, 0, 0, 0, 0, 0, 0, 0 , 0 , 0, 0, 0, 0, 0};
|
|
|
|
Modbus slave(1, 2, 0);
|
|
|
|
uint16_t channels[16];
|
|
uint8_t failSafe;
|
|
uint16_t lostFrames = 0;
|
|
|
|
const char bad_pins[] = {3, 4, 23, 24,};
|
|
|
|
void setup() {
|
|
for (int i = 0 ; i < sizeof(bad_pins) / sizeof(bad_pins[0]) ; i++) {
|
|
pinMode(bad_pins[i], INPUT);
|
|
}
|
|
|
|
pinMode(8, INPUT_PULLUP);
|
|
|
|
// analogWriteResolution(16);
|
|
x8r.begin();
|
|
slave.begin(2000000); // baud-rate at 19200
|
|
}
|
|
|
|
void loop() {
|
|
x8r.read(&channels[0], &failSafe, &lostFrames);
|
|
slave.poll( channels, num_modbus_channels );
|
|
|
|
}
|