Mouse code for the MacroRat

Dependencies:   ITG3200 QEI

Committer:
sahilmgandhi
Date:
Sat Jun 03 00:22:44 2017 +0000
Revision:
46:b156ef445742
Parent:
18:6a4db94011d3
Final code for internal battlebot competition.

Who changed what in which revision?

UserRevisionLine numberNew contents of line
sahilmgandhi 18:6a4db94011d3 1 /* mbed Microcontroller Library
sahilmgandhi 18:6a4db94011d3 2 * Copyright (c) 2006-2014 ARM Limited
sahilmgandhi 18:6a4db94011d3 3 *
sahilmgandhi 18:6a4db94011d3 4 * Licensed under the Apache License, Version 2.0 (the "License");
sahilmgandhi 18:6a4db94011d3 5 * you may not use this file except in compliance with the License.
sahilmgandhi 18:6a4db94011d3 6 * You may obtain a copy of the License at
sahilmgandhi 18:6a4db94011d3 7 *
sahilmgandhi 18:6a4db94011d3 8 * http://www.apache.org/licenses/LICENSE-2.0
sahilmgandhi 18:6a4db94011d3 9 *
sahilmgandhi 18:6a4db94011d3 10 * Unless required by applicable law or agreed to in writing, software
sahilmgandhi 18:6a4db94011d3 11 * distributed under the License is distributed on an "AS IS" BASIS,
sahilmgandhi 18:6a4db94011d3 12 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
sahilmgandhi 18:6a4db94011d3 13 * See the License for the specific language governing permissions and
sahilmgandhi 18:6a4db94011d3 14 * limitations under the License.
sahilmgandhi 18:6a4db94011d3 15 */
sahilmgandhi 18:6a4db94011d3 16 #include "mbed_assert.h"
sahilmgandhi 18:6a4db94011d3 17 #include "gpio_api.h"
sahilmgandhi 18:6a4db94011d3 18 #include "pinmap.h"
sahilmgandhi 18:6a4db94011d3 19
sahilmgandhi 18:6a4db94011d3 20 static int gpio_enabled = 0;
sahilmgandhi 18:6a4db94011d3 21
sahilmgandhi 18:6a4db94011d3 22 static void gpio_enable(void) {
sahilmgandhi 18:6a4db94011d3 23 gpio_enabled = 1;
sahilmgandhi 18:6a4db94011d3 24
sahilmgandhi 18:6a4db94011d3 25 /* Enable AHB clock to the GPIO and IOCON domain. */
sahilmgandhi 18:6a4db94011d3 26 LPC_SYSCON->SYSAHBCLKCTRL |= ((1 << 16) | (1 << 6));
sahilmgandhi 18:6a4db94011d3 27 }
sahilmgandhi 18:6a4db94011d3 28
sahilmgandhi 18:6a4db94011d3 29 uint32_t gpio_set(PinName pin) {
sahilmgandhi 18:6a4db94011d3 30 MBED_ASSERT(pin != (PinName)NC);
sahilmgandhi 18:6a4db94011d3 31 if (!gpio_enabled)
sahilmgandhi 18:6a4db94011d3 32 gpio_enable();
sahilmgandhi 18:6a4db94011d3 33
sahilmgandhi 18:6a4db94011d3 34 int func = ((pin == P0_0) || // reset
sahilmgandhi 18:6a4db94011d3 35 (pin == P0_10) || // SWCLK
sahilmgandhi 18:6a4db94011d3 36 (pin == P0_11) || // TDI
sahilmgandhi 18:6a4db94011d3 37 (pin == P0_12) || // TMS
sahilmgandhi 18:6a4db94011d3 38 (pin == P0_13) || // TDO
sahilmgandhi 18:6a4db94011d3 39 (pin == P0_14) || // TRST
sahilmgandhi 18:6a4db94011d3 40 (pin == P0_15)) ? (1) : (0); // SWDIO
sahilmgandhi 18:6a4db94011d3 41
sahilmgandhi 18:6a4db94011d3 42 pin_function(pin, func);
sahilmgandhi 18:6a4db94011d3 43
sahilmgandhi 18:6a4db94011d3 44 return (1UL << ((int)pin >> PIN_SHIFT & 0x1F));
sahilmgandhi 18:6a4db94011d3 45 }
sahilmgandhi 18:6a4db94011d3 46
sahilmgandhi 18:6a4db94011d3 47 void gpio_init(gpio_t *obj, PinName pin) {
sahilmgandhi 18:6a4db94011d3 48 obj->pin = pin;
sahilmgandhi 18:6a4db94011d3 49 if (pin == (PinName)NC)
sahilmgandhi 18:6a4db94011d3 50 return;
sahilmgandhi 18:6a4db94011d3 51
sahilmgandhi 18:6a4db94011d3 52 obj->mask = gpio_set(pin);
sahilmgandhi 18:6a4db94011d3 53
sahilmgandhi 18:6a4db94011d3 54 unsigned int port = (unsigned int)(pin >> PORT_SHIFT);
sahilmgandhi 18:6a4db94011d3 55
sahilmgandhi 18:6a4db94011d3 56 obj->reg_set = &LPC_GPIO_PORT->SET[port];
sahilmgandhi 18:6a4db94011d3 57 obj->reg_clr = &LPC_GPIO_PORT->CLR[port];
sahilmgandhi 18:6a4db94011d3 58 obj->reg_in = &LPC_GPIO_PORT->PIN[port];
sahilmgandhi 18:6a4db94011d3 59 obj->reg_dir = &LPC_GPIO_PORT->DIR[port];
sahilmgandhi 18:6a4db94011d3 60 }
sahilmgandhi 18:6a4db94011d3 61
sahilmgandhi 18:6a4db94011d3 62 void gpio_mode(gpio_t *obj, PinMode mode) {
sahilmgandhi 18:6a4db94011d3 63 pin_mode(obj->pin, mode);
sahilmgandhi 18:6a4db94011d3 64 }
sahilmgandhi 18:6a4db94011d3 65
sahilmgandhi 18:6a4db94011d3 66 void gpio_dir(gpio_t *obj, PinDirection direction) {
sahilmgandhi 18:6a4db94011d3 67 MBED_ASSERT(obj->pin != (PinName)NC);
sahilmgandhi 18:6a4db94011d3 68 switch (direction) {
sahilmgandhi 18:6a4db94011d3 69 case PIN_INPUT :
sahilmgandhi 18:6a4db94011d3 70 *obj->reg_dir &= ~obj->mask;
sahilmgandhi 18:6a4db94011d3 71 break;
sahilmgandhi 18:6a4db94011d3 72 case PIN_OUTPUT:
sahilmgandhi 18:6a4db94011d3 73 *obj->reg_dir |= obj->mask;
sahilmgandhi 18:6a4db94011d3 74 break;
sahilmgandhi 18:6a4db94011d3 75 }
sahilmgandhi 18:6a4db94011d3 76 }