fuckit: clean slate
This commit is contained in:
282
esp-vent-main/inc/Modbus/ModbusMaster.h
Normal file
282
esp-vent-main/inc/Modbus/ModbusMaster.h
Normal file
@@ -0,0 +1,282 @@
|
||||
/**
|
||||
@file
|
||||
Arduino library for communicating with Modbus slaves over RS232/485 (via RTU protocol).
|
||||
|
||||
@defgroup setup ModbusMaster Object Instantiation/Initialization
|
||||
@defgroup buffer ModbusMaster Buffer Management
|
||||
@defgroup discrete Modbus Function Codes for Discrete Coils/Inputs
|
||||
@defgroup register Modbus Function Codes for Holding/Input Registers
|
||||
@defgroup constant Modbus Function Codes, Exception Codes
|
||||
*/
|
||||
/*
|
||||
|
||||
ModbusMaster.h - Arduino library for communicating with Modbus slaves
|
||||
over RS232/485 (via RTU protocol).
|
||||
|
||||
This file is part of ModbusMaster.
|
||||
|
||||
ModbusMaster is free software: you can redistribute it and/or modify
|
||||
it under the terms of the GNU General Public License as published by
|
||||
the Free Software Foundation, either version 3 of the License, or
|
||||
(at your option) any later version.
|
||||
|
||||
ModbusMaster 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 General Public License for more details.
|
||||
|
||||
You should have received a copy of the GNU General Public License
|
||||
along with ModbusMaster. If not, see <http://www.gnu.org/licenses/>.
|
||||
|
||||
Written by Doc Walker (Rx)
|
||||
Copyright © 2009-2013 Doc Walker <4-20ma at wvfans dot net>
|
||||
|
||||
*/
|
||||
|
||||
|
||||
#ifndef ModbusMaster_h
|
||||
#define ModbusMaster_h
|
||||
|
||||
|
||||
/**
|
||||
@def __MODBUSMASTER_DEBUG__ (1).
|
||||
Set to 1 to enable debugging features within class:
|
||||
- pin 4 cycles for each byte read in the Modbus response
|
||||
- pin 5 cycles for each millisecond timeout during the Modbus response
|
||||
*/
|
||||
#define __MODBUSMASTER_DEBUG__ (0)
|
||||
|
||||
|
||||
/* _____STANDARD INCLUDES____________________________________________________ */
|
||||
// include types & constants of Wiring core API
|
||||
#if defined(ARDUINO) && ARDUINO >= 100
|
||||
#include "Arduino.h"
|
||||
#else
|
||||
//#include "WProgram.h"
|
||||
#include <stdint.h>
|
||||
#include <cstddef>
|
||||
#endif
|
||||
|
||||
uint32_t millis();
|
||||
#define BYTE 0xA5
|
||||
|
||||
/* _____UTILITY MACROS_______________________________________________________ */
|
||||
|
||||
|
||||
/* _____PROJECT INCLUDES_____________________________________________________ */
|
||||
// functions to calculate Modbus Application Data Unit CRC
|
||||
//#include "util/crc16.h"
|
||||
// moved inlcuding crc16.h to ModbusMaster.cpp
|
||||
|
||||
// functions to manipulate words
|
||||
///#include "util/word.h"
|
||||
#include "word.h"
|
||||
|
||||
|
||||
#include "SerialPort.h"
|
||||
|
||||
/* _____CLASS DEFINITIONS____________________________________________________ */
|
||||
/**
|
||||
Arduino class library for communicating with Modbus slaves over
|
||||
RS232/485 (via RTU protocol).
|
||||
*/
|
||||
class ModbusMaster
|
||||
{
|
||||
public:
|
||||
ModbusMaster();
|
||||
ModbusMaster(uint8_t);
|
||||
ModbusMaster(uint8_t, uint8_t);
|
||||
|
||||
void begin();
|
||||
void begin(uint16_t);
|
||||
void idle(void (*)());
|
||||
|
||||
// Modbus exception codes
|
||||
/**
|
||||
Modbus protocol illegal function exception.
|
||||
|
||||
The function code received in the query is not an allowable action for
|
||||
the server (or slave). This may be because the function code is only
|
||||
applicable to newer devices, and was not implemented in the unit
|
||||
selected. It could also indicate that the server (or slave) is in the
|
||||
wrong state to process a request of this type, for example because it is
|
||||
unconfigured and is being asked to return register values.
|
||||
|
||||
@ingroup constant
|
||||
*/
|
||||
static const uint8_t ku8MBIllegalFunction = 0x01;
|
||||
|
||||
/**
|
||||
Modbus protocol illegal data address exception.
|
||||
|
||||
The data address received in the query is not an allowable address for
|
||||
the server (or slave). More specifically, the combination of reference
|
||||
number and transfer length is invalid. For a controller with 100
|
||||
registers, the ADU addresses the first register as 0, and the last one
|
||||
as 99. If a request is submitted with a starting register address of 96
|
||||
and a quantity of registers of 4, then this request will successfully
|
||||
operate (address-wise at least) on registers 96, 97, 98, 99. If a
|
||||
request is submitted with a starting register address of 96 and a
|
||||
quantity of registers of 5, then this request will fail with Exception
|
||||
Code 0x02 "Illegal Data Address" since it attempts to operate on
|
||||
registers 96, 97, 98, 99 and 100, and there is no register with address
|
||||
100.
|
||||
|
||||
@ingroup constant
|
||||
*/
|
||||
static const uint8_t ku8MBIllegalDataAddress = 0x02;
|
||||
|
||||
/**
|
||||
Modbus protocol illegal data value exception.
|
||||
|
||||
A value contained in the query data field is not an allowable value for
|
||||
server (or slave). This indicates a fault in the structure of the
|
||||
remainder of a complex request, such as that the implied length is
|
||||
incorrect. It specifically does NOT mean that a data item submitted for
|
||||
storage in a register has a value outside the expectation of the
|
||||
application program, since the MODBUS protocol is unaware of the
|
||||
significance of any particular value of any particular register.
|
||||
|
||||
@ingroup constant
|
||||
*/
|
||||
static const uint8_t ku8MBIllegalDataValue = 0x03;
|
||||
|
||||
/**
|
||||
Modbus protocol slave device failure exception.
|
||||
|
||||
An unrecoverable error occurred while the server (or slave) was
|
||||
attempting to perform the requested action.
|
||||
|
||||
@ingroup constant
|
||||
*/
|
||||
static const uint8_t ku8MBSlaveDeviceFailure = 0x04;
|
||||
|
||||
// Class-defined success/exception codes
|
||||
/**
|
||||
ModbusMaster success.
|
||||
|
||||
Modbus transaction was successful; the following checks were valid:
|
||||
- slave ID
|
||||
- function code
|
||||
- response code
|
||||
- data
|
||||
- CRC
|
||||
|
||||
@ingroup constant
|
||||
*/
|
||||
static const uint8_t ku8MBSuccess = 0x00;
|
||||
|
||||
/**
|
||||
ModbusMaster invalid response slave ID exception.
|
||||
|
||||
The slave ID in the response does not match that of the request.
|
||||
|
||||
@ingroup constant
|
||||
*/
|
||||
static const uint8_t ku8MBInvalidSlaveID = 0xE0;
|
||||
|
||||
/**
|
||||
ModbusMaster invalid response function exception.
|
||||
|
||||
The function code in the response does not match that of the request.
|
||||
|
||||
@ingroup constant
|
||||
*/
|
||||
static const uint8_t ku8MBInvalidFunction = 0xE1;
|
||||
|
||||
/**
|
||||
ModbusMaster response timed out exception.
|
||||
|
||||
The entire response was not received within the timeout period,
|
||||
ModbusMaster::ku8MBResponseTimeout.
|
||||
|
||||
@ingroup constant
|
||||
*/
|
||||
static const uint8_t ku8MBResponseTimedOut = 0xE2;
|
||||
|
||||
/**
|
||||
ModbusMaster invalid response CRC exception.
|
||||
|
||||
The CRC in the response does not match the one calculated.
|
||||
|
||||
@ingroup constant
|
||||
*/
|
||||
static const uint8_t ku8MBInvalidCRC = 0xE3;
|
||||
|
||||
uint16_t getResponseBuffer(uint8_t);
|
||||
void clearResponseBuffer();
|
||||
uint8_t setTransmitBuffer(uint8_t, uint16_t);
|
||||
void clearTransmitBuffer();
|
||||
|
||||
void beginTransmission(uint16_t);
|
||||
uint8_t requestFrom(uint16_t, uint16_t);
|
||||
void sendBit(bool);
|
||||
void send(uint8_t);
|
||||
void send(uint16_t);
|
||||
void send(uint32_t);
|
||||
uint8_t available(void);
|
||||
uint16_t receive(void);
|
||||
|
||||
|
||||
uint8_t readCoils(uint16_t, uint16_t);
|
||||
uint8_t readDiscreteInputs(uint16_t, uint16_t);
|
||||
uint8_t readHoldingRegisters(uint16_t, uint16_t);
|
||||
uint8_t readInputRegisters(uint16_t, uint8_t);
|
||||
uint8_t writeSingleCoil(uint16_t, uint8_t);
|
||||
uint8_t writeSingleRegister(uint16_t, uint16_t);
|
||||
uint8_t writeMultipleCoils(uint16_t, uint16_t);
|
||||
uint8_t writeMultipleCoils();
|
||||
uint8_t writeMultipleRegisters(uint16_t, uint16_t);
|
||||
uint8_t writeMultipleRegisters();
|
||||
uint8_t maskWriteRegister(uint16_t, uint16_t, uint16_t);
|
||||
uint8_t readWriteMultipleRegisters(uint16_t, uint16_t, uint16_t, uint16_t);
|
||||
uint8_t readWriteMultipleRegisters(uint16_t, uint16_t);
|
||||
|
||||
private:
|
||||
uint8_t _u8SerialPort; ///< serial port (0..3) initialized in constructor
|
||||
uint8_t _u8MBSlave; ///< Modbus slave (1..255) initialized in constructor
|
||||
uint16_t _u16BaudRate; ///< baud rate (300..115200) initialized in begin()
|
||||
static const uint8_t ku8MaxBufferSize = 64; ///< size of response/transmit buffers
|
||||
uint16_t _u16ReadAddress; ///< slave register from which to read
|
||||
uint16_t _u16ReadQty; ///< quantity of words to read
|
||||
uint16_t _u16ResponseBuffer[ku8MaxBufferSize]; ///< buffer to store Modbus slave response; read via GetResponseBuffer()
|
||||
uint16_t _u16WriteAddress; ///< slave register to which to write
|
||||
uint16_t _u16WriteQty; ///< quantity of words to write
|
||||
uint16_t _u16TransmitBuffer[ku8MaxBufferSize]; ///< buffer containing data to transmit to Modbus slave; set via SetTransmitBuffer()
|
||||
uint16_t* txBuffer; // from Wire.h -- need to clean this up Rx
|
||||
uint8_t _u8TransmitBufferIndex;
|
||||
uint16_t u16TransmitBufferLength;
|
||||
uint16_t* rxBuffer; // from Wire.h -- need to clean this up Rx
|
||||
uint8_t _u8ResponseBufferIndex;
|
||||
uint8_t _u8ResponseBufferLength;
|
||||
|
||||
// Modbus function codes for bit access
|
||||
static const uint8_t ku8MBReadCoils = 0x01; ///< Modbus function 0x01 Read Coils
|
||||
static const uint8_t ku8MBReadDiscreteInputs = 0x02; ///< Modbus function 0x02 Read Discrete Inputs
|
||||
static const uint8_t ku8MBWriteSingleCoil = 0x05; ///< Modbus function 0x05 Write Single Coil
|
||||
static const uint8_t ku8MBWriteMultipleCoils = 0x0F; ///< Modbus function 0x0F Write Multiple Coils
|
||||
|
||||
// Modbus function codes for 16 bit access
|
||||
static const uint8_t ku8MBReadHoldingRegisters = 0x03; ///< Modbus function 0x03 Read Holding Registers
|
||||
static const uint8_t ku8MBReadInputRegisters = 0x04; ///< Modbus function 0x04 Read Input Registers
|
||||
static const uint8_t ku8MBWriteSingleRegister = 0x06; ///< Modbus function 0x06 Write Single Register
|
||||
static const uint8_t ku8MBWriteMultipleRegisters = 0x10; ///< Modbus function 0x10 Write Multiple Registers
|
||||
static const uint8_t ku8MBMaskWriteRegister = 0x16; ///< Modbus function 0x16 Mask Write Register
|
||||
static const uint8_t ku8MBReadWriteMultipleRegisters = 0x17; ///< Modbus function 0x17 Read Write Multiple Registers
|
||||
|
||||
// Modbus timeout [milliseconds]
|
||||
static const uint16_t ku16MBResponseTimeout = 2000; ///< Modbus timeout [milliseconds]
|
||||
|
||||
// master function that conducts Modbus transactions
|
||||
uint8_t ModbusMasterTransaction(uint8_t u8MBFunction);
|
||||
|
||||
// idle callback function; gets called during idle time between TX and RX
|
||||
void (*_idle)();
|
||||
SerialPort *MBSerial = NULL; // added by KRL
|
||||
};
|
||||
#endif
|
||||
|
||||
/**
|
||||
@example examples/Basic/Basic.pde
|
||||
@example examples/PhoenixContact_nanoLC/PhoenixContact_nanoLC.pde
|
||||
*/
|
||||
19
esp-vent-main/inc/Modbus/ModbusRegister.h
Normal file
19
esp-vent-main/inc/Modbus/ModbusRegister.h
Normal file
@@ -0,0 +1,19 @@
|
||||
#ifndef MODBUSREGISTER_H_
|
||||
#define MODBUSREGISTER_H_
|
||||
|
||||
#include "ModbusMaster.h"
|
||||
|
||||
class ModbusRegister {
|
||||
public:
|
||||
ModbusRegister(ModbusMaster *master, int address, bool holdingRegister = true);
|
||||
ModbusRegister(const ModbusRegister &) = delete;
|
||||
virtual ~ModbusRegister();
|
||||
int read();
|
||||
void write(int value);
|
||||
private:
|
||||
ModbusMaster *m;
|
||||
int addr;
|
||||
bool hr;
|
||||
};
|
||||
|
||||
#endif /* MODBUSREGISTER_H_ */
|
||||
20
esp-vent-main/inc/Modbus/SerialPort.h
Normal file
20
esp-vent-main/inc/Modbus/SerialPort.h
Normal file
@@ -0,0 +1,20 @@
|
||||
#ifndef SERIALPORT_H_
|
||||
#define SERIALPORT_H_
|
||||
|
||||
#include "Uart.h"
|
||||
|
||||
class SerialPort {
|
||||
public:
|
||||
SerialPort();
|
||||
virtual ~SerialPort();
|
||||
int available();
|
||||
void begin(int speed = 9600);
|
||||
int read();
|
||||
int write(const char* buf, int len);
|
||||
int print(int val, int format);
|
||||
void flush();
|
||||
private:
|
||||
static LpcUart *u;
|
||||
};
|
||||
|
||||
#endif /* SERIALPORT_H_ */
|
||||
54
esp-vent-main/inc/Modbus/Uart.h
Normal file
54
esp-vent-main/inc/Modbus/Uart.h
Normal file
@@ -0,0 +1,54 @@
|
||||
#ifndef LPCUART_H_
|
||||
#define LPCUART_H_
|
||||
|
||||
#include "chip.h"
|
||||
|
||||
struct LpcPinMap {
|
||||
int port; /* set to -1 to indicate unused pin */
|
||||
int pin; /* set to -1 to indicate unused pin */
|
||||
};
|
||||
|
||||
struct LpcUartConfig {
|
||||
LPC_USART_T *pUART;
|
||||
uint32_t speed;
|
||||
uint32_t data;
|
||||
bool rs485;
|
||||
LpcPinMap tx;
|
||||
LpcPinMap rx;
|
||||
LpcPinMap rts; /* used as output enable if RS-485 mode is enabled */
|
||||
LpcPinMap cts;
|
||||
};
|
||||
|
||||
|
||||
class LpcUart {
|
||||
public:
|
||||
LpcUart(const LpcUartConfig &cfg);
|
||||
LpcUart(const LpcUart &) = delete;
|
||||
virtual ~LpcUart();
|
||||
int free(); /* get amount of free space in transmit buffer */
|
||||
int peek(); /* get number of received characters in receive buffer */
|
||||
int write(char c);
|
||||
int write(const char *s);
|
||||
int write(const char *buffer, int len);
|
||||
int read(char &c); /* get a single character. Returns number of characters read --> returns 0 if no character is available */
|
||||
int read(char *buffer, int len);
|
||||
void txbreak(bool brk); /* set break signal on */
|
||||
bool rxbreak(); /* check if break is received */
|
||||
void speed(int bps); /* change transmission speed */
|
||||
bool txempty();
|
||||
|
||||
void isr(); /* ISR handler. This will be called by the HW ISR handler. Do not call from application */
|
||||
private:
|
||||
LPC_USART_T *uart;
|
||||
IRQn_Type irqn;
|
||||
/* currently we support only fixed size ring buffers */
|
||||
static const int UART_RB_SIZE = 256;
|
||||
/* Transmit and receive ring buffers */
|
||||
RINGBUFF_T txring;
|
||||
RINGBUFF_T rxring;
|
||||
uint8_t rxbuff[UART_RB_SIZE];
|
||||
uint8_t txbuff[UART_RB_SIZE];
|
||||
static bool init; /* set when first UART is initialized. We have a global clock setting for all UARTSs */
|
||||
};
|
||||
|
||||
#endif /* LPCUART_H_ */
|
||||
86
esp-vent-main/inc/Modbus/crc16.h
Normal file
86
esp-vent-main/inc/Modbus/crc16.h
Normal file
@@ -0,0 +1,86 @@
|
||||
/**
|
||||
@file
|
||||
CRC Computations
|
||||
|
||||
@defgroup util_crc16 "util/crc16.h": CRC Computations
|
||||
@code#include "util/crc16.h"@endcode
|
||||
|
||||
This header file provides functions for calculating
|
||||
cyclic redundancy checks (CRC) using common polynomials.
|
||||
Modified by Doc Walker to be processor-independent (removed inline
|
||||
assembler to allow it to compile on SAM3X8E processors).
|
||||
|
||||
@par References:
|
||||
Jack Crenshaw's "Implementing CRCs" article in the January 1992 issue of @e
|
||||
Embedded @e Systems @e Programming. This may be difficult to find, but it
|
||||
explains CRC's in very clear and concise terms. Well worth the effort to
|
||||
obtain a copy.
|
||||
|
||||
*/
|
||||
/* Copyright (c) 2002, 2003, 2004 Marek Michalkiewicz
|
||||
Copyright (c) 2005, 2007 Joerg Wunsch
|
||||
Copyright (c) 2013 Dave Hylands
|
||||
Copyright (c) 2013 Frederic Nadeau
|
||||
Copyright (c) 2015 Doc Walker
|
||||
All rights reserved.
|
||||
|
||||
Redistribution and use in source and binary forms, with or without
|
||||
modification, are permitted provided that the following conditions are met:
|
||||
|
||||
* Redistributions of source code must retain the above copyright
|
||||
notice, this list of conditions and the following disclaimer.
|
||||
|
||||
* Redistributions in binary form must reproduce the above copyright
|
||||
notice, this list of conditions and the following disclaimer in
|
||||
the documentation and/or other materials provided with the
|
||||
distribution.
|
||||
|
||||
* Neither the name of the copyright holders nor the names of
|
||||
contributors may be used to endorse or promote products derived
|
||||
from this software without specific prior written permission.
|
||||
|
||||
THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
|
||||
AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
|
||||
IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
|
||||
ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
|
||||
LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
|
||||
CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
|
||||
SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
|
||||
INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
|
||||
CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
|
||||
ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
|
||||
POSSIBILITY OF SUCH DAMAGE. */
|
||||
|
||||
#ifndef _UTIL_CRC16_H_
|
||||
#define _UTIL_CRC16_H_
|
||||
|
||||
/** @ingroup util_crc16
|
||||
Processor-independent CRC-16 calculation.
|
||||
|
||||
Polynomial: x^16 + x^15 + x^2 + 1 (0xA001)<br>
|
||||
Initial value: 0xFFFF
|
||||
|
||||
This CRC is normally used in disk-drive controllers.
|
||||
|
||||
@param uint16_t crc (0x0000..0xFFFF)
|
||||
@param uint8_t a (0x00..0xFF)
|
||||
@return calculated CRC (0x0000..0xFFFF)
|
||||
*/
|
||||
static uint16_t
|
||||
crc16_update (uint16_t crc, uint8_t a)
|
||||
{
|
||||
int i;
|
||||
|
||||
crc ^= a;
|
||||
for (i = 0; i < 8; ++i)
|
||||
{
|
||||
if (crc & 1)
|
||||
crc = (crc >> 1) ^ 0xA001;
|
||||
else
|
||||
crc = (crc >> 1);
|
||||
}
|
||||
|
||||
return crc;
|
||||
}
|
||||
|
||||
#endif /* _UTIL_CRC16_H_ */
|
||||
98
esp-vent-main/inc/Modbus/word.h
Normal file
98
esp-vent-main/inc/Modbus/word.h
Normal file
@@ -0,0 +1,98 @@
|
||||
/**
|
||||
@file
|
||||
Utility Functions for Manipulating Words
|
||||
|
||||
@defgroup util_word "util/word.h": Utility Functions for Manipulating Words
|
||||
@code#include "util/word.h"@endcode
|
||||
|
||||
This header file provides utility functions for manipulating words.
|
||||
|
||||
*/
|
||||
/*
|
||||
|
||||
word.h - Utility Functions for Manipulating Words
|
||||
|
||||
This file is part of ModbusMaster.
|
||||
|
||||
ModbusMaster is free software: you can redistribute it and/or modify
|
||||
it under the terms of the GNU General Public License as published by
|
||||
the Free Software Foundation, either version 3 of the License, or
|
||||
(at your option) any later version.
|
||||
|
||||
ModbusMaster 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 General Public License for more details.
|
||||
|
||||
You should have received a copy of the GNU General Public License
|
||||
along with ModbusMaster. If not, see <http://www.gnu.org/licenses/>.
|
||||
|
||||
Written by Doc Walker (Rx)
|
||||
Copyright © 2009-2015 Doc Walker <4-20ma at wvfans dot net>
|
||||
|
||||
*/
|
||||
|
||||
|
||||
#ifndef _UTIL_WORD_H_
|
||||
#define _UTIL_WORD_H_
|
||||
|
||||
|
||||
/** @ingroup util_word
|
||||
Return low word of a 32-bit integer.
|
||||
|
||||
@param uint32_t ww (0x00000000..0xFFFFFFFF)
|
||||
@return low word of input (0x0000..0xFFFF)
|
||||
*/
|
||||
static inline uint16_t lowWord(uint32_t ww)
|
||||
{
|
||||
return (uint16_t) ((ww) & 0xFFFF);
|
||||
}
|
||||
|
||||
|
||||
/** @ingroup util_word
|
||||
Return high word of a 32-bit integer.
|
||||
|
||||
@param uint32_t ww (0x00000000..0xFFFFFFFF)
|
||||
@return high word of input (0x0000..0xFFFF)
|
||||
*/
|
||||
static inline uint16_t highWord(uint32_t ww)
|
||||
{
|
||||
return (uint16_t) ((ww) >> 16);
|
||||
}
|
||||
|
||||
/* utility functions for porting ModbusMaster to LPCXpresso
|
||||
* added by krl
|
||||
*/
|
||||
static inline uint16_t word(uint8_t ww)
|
||||
{
|
||||
return (uint16_t) (ww);
|
||||
}
|
||||
|
||||
static inline uint16_t word(uint8_t h, uint8_t l)
|
||||
{
|
||||
return (uint16_t) ((h << 8) | l);
|
||||
}
|
||||
|
||||
static inline uint8_t highByte(uint16_t v)
|
||||
{
|
||||
return (uint8_t) ((v >> 8) & 0xFF);
|
||||
}
|
||||
|
||||
static inline uint16_t lowByte(uint16_t v)
|
||||
{
|
||||
return (uint8_t) (v & 0xFF);
|
||||
}
|
||||
|
||||
static inline uint8_t bitRead(uint8_t v, uint8_t n)
|
||||
{
|
||||
return (uint8_t) (v & (1 << n) ? 1 : 0);
|
||||
}
|
||||
|
||||
static inline void bitWrite(uint16_t& v, uint8_t n, uint8_t b)
|
||||
{
|
||||
if(b) v = v | (1 << n);
|
||||
else v = v & ~(1 << n);
|
||||
}
|
||||
|
||||
|
||||
#endif /* _UTIL_WORD_H_ */
|
||||
Reference in New Issue
Block a user