You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
55 lines
1.6 KiB
55 lines
1.6 KiB
12 months ago
|
/**
|
||
|
|
@file Servo.ino
|
||
|
|
Copyright (C) 2023 Pascal JEAN aka epsilonrt
|
||
|
|
Copyright (C) 2014 André Sarmento Barbosa
|
||
|
|
https://github.com/epsilonrt/modbus-serial
|
||
|
|
|
||
|
|
Use Servo lib
|
||
|
|
This library only supports boards with an AVR, SAM, SAMD, NRF52 or STM32F4 processor.
|
||
|
|
https://registry.platformio.org/libraries/arduino-libraries/Servo
|
||
|
|
*/
|
||
|
|
|
||
|
|
#include <ModbusSerial.h>
|
||
|
|
#include <Servo.h>
|
||
|
|
|
||
|
|
// Used Pins
|
||
|
|
const int servoPin = 9;
|
||
|
|
const int TxenPin = -1; // -1 disables the feature, change that if you are using an RS485 driver, this pin would be connected to the DE and /RE pins of the driver.
|
||
|
|
|
||
|
|
const byte SlaveId = 12;
|
||
|
|
// Modbus Registers Offsets (0-9999)
|
||
|
|
const int ServoHreg = 0;
|
||
|
|
|
||
|
|
#define MySerial Serial // define serial port used, Serial most of the time, or Serial1, Serial2 ... if available
|
||
|
|
const unsigned long Baudrate = 38400;
|
||
|
|
|
||
|
|
// ModbusSerial object
|
||
|
|
ModbusSerial mb (MySerial, SlaveId, TxenPin);
|
||
|
|
// Servo object
|
||
|
|
Servo servo;
|
||
|
|
|
||
|
|
void setup() {
|
||
|
|
|
||
|
|
MySerial.begin (Baudrate); // works on all boards but the configuration is 8N1 which is incompatible with the MODBUS standard
|
||
|
|
// prefer the line below instead if possible
|
||
|
|
// MySerial.begin (Baudrate, MB_PARITY_EVEN);
|
||
|
|
|
||
|
|
mb.config (Baudrate);
|
||
|
|
mb.setAdditionalServerData ("SWITCH"); // for Report Server ID function (0x11)
|
||
|
|
|
||
|
|
// Attaches the servo pin to the servo object
|
||
|
|
servo.attach (servoPin);
|
||
|
|
// Add ServoHreg register - Use addHreg() for analog outpus or to store values in device
|
||
|
|
mb.addHreg (ServoHreg, 127);
|
||
|
|
}
|
||
|
|
|
||
|
|
void loop() {
|
||
|
|
|
||
|
|
//Call once inside loop() - all magic here
|
||
|
|
mb.task();
|
||
|
|
|
||
|
|
//Attach switchPin to SWITCH_ISTS register
|
||
|
|
servo.write (mb.Hreg (ServoHreg));
|
||
|
|
delay (15);
|
||
|
|
}
|