mirror of https://github.com/ArduPilot/ardupilot
145 lines
3.9 KiB
C++
145 lines
3.9 KiB
C++
/*
|
|
This program 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.
|
|
|
|
This program 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 this program. If not, see <http://www.gnu.org/licenses/>.
|
|
*/
|
|
/*
|
|
Flymaple port by Mike McCauley
|
|
CAUTION: correct compilation and operation of this code depends on
|
|
using the fork of libmaple from https://github.com/mikemccauley/libmaple.git
|
|
*/
|
|
|
|
#include <AP_HAL/AP_HAL.h>
|
|
|
|
#if CONFIG_HAL_BOARD == HAL_BOARD_FLYMAPLE
|
|
#include <stdlib.h>
|
|
|
|
#include "UARTDriver.h"
|
|
#include "FlymapleWirish.h"
|
|
#include <HardwareSerial.h>
|
|
#include <usart.h>
|
|
|
|
using namespace AP_HAL_FLYMAPLE_NS;
|
|
|
|
extern const AP_HAL::HAL& hal;
|
|
|
|
FLYMAPLEUARTDriver::FLYMAPLEUARTDriver(HardwareSerial* hws):
|
|
_hws(hws),
|
|
_txBuf(NULL),
|
|
_txBufSize(63), // libmaple internal usart default driver buffer is 63
|
|
_rxBuf(NULL),
|
|
_rxBufSize(63) // libmaple internal usart default driver buffer is 63
|
|
{}
|
|
|
|
void FLYMAPLEUARTDriver::begin(uint32_t b)
|
|
{
|
|
// Dont let the ISRs access the ring buffers until we are fully set up:
|
|
nvic_irq_disable(_hws->c_dev()->irq_num);
|
|
_hws->begin(b);
|
|
if (_txBuf)
|
|
rb_init(_hws->c_dev()->tx_rb, _txBufSize, _txBuf); // Get the TX ring buffer size we want
|
|
if (_rxBuf)
|
|
rb_init(_hws->c_dev()->rb, _rxBufSize, _rxBuf); // Get the RX ring buffer size we want
|
|
nvic_irq_enable(_hws->c_dev()->irq_num);
|
|
}
|
|
|
|
void FLYMAPLEUARTDriver::begin(uint32_t b, uint16_t rxS, uint16_t txS)
|
|
{
|
|
// Our private buffers can only grow, never shrink
|
|
// rxS == 0 or txS == 0 means no change to buffer size
|
|
uint8_t* oldRxBuf = NULL;
|
|
uint8_t* oldTxBuf = NULL;
|
|
// Maybe a new TX buffer?
|
|
if (txS && (txS > _txBufSize))
|
|
{
|
|
oldTxBuf = _txBuf;
|
|
_txBuf = (uint8_t*)malloc(txS); // Caution: old contents lost
|
|
_txBufSize = txS;
|
|
}
|
|
// Maybe a new RX buffer?
|
|
if (rxS && (rxS > _rxBufSize))
|
|
{
|
|
oldRxBuf = _rxBuf;
|
|
_rxBuf = (uint8_t*)malloc(rxS); // Caution: old contents lost
|
|
_rxBufSize = rxS;
|
|
}
|
|
|
|
// Dont let the IRs access the ring buffers until we are fully set up:
|
|
nvic_irq_disable(_hws->c_dev()->irq_num);
|
|
begin(b); // libmaple internal ring buffer reinitialised to defaults here
|
|
if (_txBuf)
|
|
rb_init(_hws->c_dev()->tx_rb, _txBufSize, _txBuf); // Get the TX ring buffer size we want
|
|
if (_rxBuf)
|
|
rb_init(_hws->c_dev()->rb, _rxBufSize, _rxBuf); // Get the RX ring buffer size we want
|
|
nvic_irq_enable(_hws->c_dev()->irq_num);
|
|
|
|
// Now its safe to free any old buffers
|
|
if (oldTxBuf)
|
|
free(oldTxBuf);
|
|
if (oldRxBuf)
|
|
free(oldRxBuf);
|
|
}
|
|
|
|
void FLYMAPLEUARTDriver::end()
|
|
{
|
|
_hws->end();
|
|
}
|
|
|
|
void FLYMAPLEUARTDriver::flush()
|
|
{
|
|
_hws->flush();
|
|
}
|
|
|
|
bool FLYMAPLEUARTDriver::is_initialized()
|
|
{
|
|
return true;
|
|
}
|
|
|
|
void FLYMAPLEUARTDriver::set_blocking_writes(bool blocking) {}
|
|
|
|
bool FLYMAPLEUARTDriver::tx_pending() { return false; }
|
|
|
|
/* FLYMAPLE implementations of Stream virtual methods */
|
|
int16_t FLYMAPLEUARTDriver::available()
|
|
{
|
|
return _hws->available();
|
|
}
|
|
|
|
int16_t FLYMAPLEUARTDriver::txspace()
|
|
{
|
|
// Mikems fork of libmaple includes usart TX buffering
|
|
return _hws->c_dev()->tx_rb->size - rb_full_count(_hws->c_dev()->tx_rb);
|
|
}
|
|
|
|
int16_t FLYMAPLEUARTDriver::read()
|
|
{
|
|
return _hws->read();
|
|
}
|
|
|
|
/* FLYMAPLE implementations of Print virtual methods */
|
|
size_t FLYMAPLEUARTDriver::write(uint8_t c)
|
|
{
|
|
_hws->write(c);
|
|
return 1;
|
|
}
|
|
|
|
size_t FLYMAPLEUARTDriver::write(const uint8_t *buffer, size_t size)
|
|
{
|
|
size_t n = 0;
|
|
while (size--) {
|
|
n += write(*buffer++);
|
|
}
|
|
return n;
|
|
}
|
|
|
|
#endif
|