1 files changed, 53 insertions, 0 deletions
diff --git a/libmaple/gpio.c b/libmaple/gpio.c
new file mode 100644
index 0000000..39341af
--- /dev/null
+++ b/libmaple/gpio.c
@@ -0,0 +1,53 @@
+/* *****************************************************************************
+ *  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/>.
+ *
+ *  Created: 12/18/09 02:35:49
+ *  Copyright (c) 2009 Perry L. Hung. All rights reserved.
+ *
+ * ****************************************************************************/
+
+/**
+ *  @file gpio.c
+ *
+ *  @brief GPIO initialization routine
+ */
+
+#include "libmaple.h"
+#include "rcc.h"
+#include "gpio.h"
+
+void gpio_init(void) {
+   rcc_enable_clk_gpioa();
+   rcc_enable_clk_gpiob();
+   rcc_enable_clk_gpioc();
+   rcc_enable_clk_gpiod();
+   rcc_enable_clk_afio();
+}
+
+void gpio_set_mode(GPIO_Port* port, uint8 gpio_pin, uint8 mode) {
+    uint32_t tmp;
+    uint32_t shift = POS(gpio_pin % 8);
+    GPIOReg CR;
+
+    ASSERT(port);
+    ASSERT(gpio_pin < 16);
+
+    CR = (gpio_pin < 8) ? &(port->CRL) : &(port->CRH);
+
+    tmp = *CR;
+    tmp &= POS_MASK(shift);
+    tmp |= mode << shift;
+
+    *CR = tmp;
+}