1 files changed, 88 insertions, 0 deletions
diff --git a/cm3cpp/rs485.cpp b/cm3cpp/rs485.cpp
new file mode 100644
index 0000000..ff7c338
--- /dev/null
+++ b/cm3cpp/rs485.cpp
@@ -0,0 +1,88 @@
+/*
+ * This file is part of the libopencm3_cpp_extensions project.
+ * hosted at http://github.com/thirdpin/libopencm3_cpp_extensions
+ *
+ * Copyright (C) 2016  Third Pin LLC
+ * Written by Anastasiia Lazareva <a.lazareva@thirdpin.ru>
+ *
+ * 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/>.
+ */
+
+/*
+RS485 implementation, public interface
+*/
+
+#include "rs485.hpp"
+
+namespace cm3cpp {
+
+RS485::RS485(Struct rs485,
+             Settings settings,
+             utils::RoundBuffer rb_in_size,
+             utils::RoundBuffer rb_out_size) :
+  _de(rs485.de)
+{
+    rb_in = new utils::RoundBuffer(rb_in_size);
+    rb_out = new utils::RoundBuffer(rb_out_size);
+
+    if (rs485.rx.pin) {
+        Gpio rx(rs485.rx);
+        rx.mode_setup(Gpio::Mode::ALTERNATE_FUNCTION, Gpio::PullMode::NO_PULL);
+        rx.set_output_options(Gpio::OutputType::PUSH_PULL,
+                              Gpio::Speed::MEDIUM_25MHz);
+        rx.set_af(Gpio::AltFuncNumber::AF7);
+    }
+
+    if (rs485.tx.pin) {
+        Gpio tx(rs485.tx);
+        tx.mode_setup(Gpio::Mode::ALTERNATE_FUNCTION, Gpio::PullMode::NO_PULL);
+        tx.set_output_options(Gpio::OutputType::PUSH_PULL,
+                              Gpio::Speed::MEDIUM_25MHz);
+        tx.set_af(Gpio::AltFuncNumber::AF7);
+    }
+
+    _de.mode_setup(Gpio::Mode::OUTPUT, Gpio::PullMode::NO_PULL);
+    _de.set_output_options(Gpio::OutputType::PUSH_PULL,
+                           Gpio::Speed::MEDIUM_25MHz);
+    _de.clear();
+
+    switch (rs485.number) {
+        case 1:
+            _rs485 = USART1;
+            nvic_enable_irq(NVIC_USART1_IRQ);
+            break;
+        case 2:
+            _rs485 = USART2;
+            nvic_enable_irq(NVIC_USART2_IRQ);
+            break;
+        case 3:
+            _rs485 = USART3;
+            nvic_enable_irq(NVIC_USART3_IRQ);
+            break;
+    }
+
+    usart_set_baudrate(_rs485, settings.baud_rate);
+    usart_set_databits(_rs485, settings.word_length);
+    usart_set_stopbits(_rs485, settings.stop_bits);
+    usart_set_mode(_rs485, settings.mode);
+    usart_set_parity(_rs485, settings.parity);
+    usart_set_flow_control(_rs485, settings.flow_control);
+
+    if (settings.mode & USART_MODE_RX)
+        usart_enable_rx_interrupt(_rs485);
+
+    usart_enable(_rs485);
+}
+
+}  // namespace cm3cpp