BA / SerialCom

Fork of OmniWheels by Gustav Atmel

Committer:
gustavatmel
Date:
Tue May 01 15:55:34 2018 +0000
Revision:
2:798925c9e4a8
Parent:
1:9c5af431a1f1
bluetooth

Who changed what in which revision?

UserRevisionLine numberNew contents of line
gustavatmel 1:9c5af431a1f1 1 /* mbed Microcontroller Library
gustavatmel 1:9c5af431a1f1 2 * Copyright (c) 2006-2013 ARM Limited
gustavatmel 1:9c5af431a1f1 3 *
gustavatmel 1:9c5af431a1f1 4 * Licensed under the Apache License, Version 2.0 (the "License");
gustavatmel 1:9c5af431a1f1 5 * you may not use this file except in compliance with the License.
gustavatmel 1:9c5af431a1f1 6 * You may obtain a copy of the License at
gustavatmel 1:9c5af431a1f1 7 *
gustavatmel 1:9c5af431a1f1 8 * http://www.apache.org/licenses/LICENSE-2.0
gustavatmel 1:9c5af431a1f1 9 *
gustavatmel 1:9c5af431a1f1 10 * Unless required by applicable law or agreed to in writing, software
gustavatmel 1:9c5af431a1f1 11 * distributed under the License is distributed on an "AS IS" BASIS,
gustavatmel 1:9c5af431a1f1 12 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
gustavatmel 1:9c5af431a1f1 13 * See the License for the specific language governing permissions and
gustavatmel 1:9c5af431a1f1 14 * limitations under the License.
gustavatmel 1:9c5af431a1f1 15 */
gustavatmel 1:9c5af431a1f1 16 #include "PeripheralPins.h"
gustavatmel 1:9c5af431a1f1 17 #include "mbed_error.h"
gustavatmel 1:9c5af431a1f1 18 #include "gpio_addrdefine.h"
gustavatmel 1:9c5af431a1f1 19
gustavatmel 1:9c5af431a1f1 20 PinName gpio_multi_guard = (PinName)NC; /* If set pin name here, setting of the "pin" is just one time */
gustavatmel 1:9c5af431a1f1 21
gustavatmel 1:9c5af431a1f1 22 void pin_function(PinName pin, int function) {
gustavatmel 1:9c5af431a1f1 23 if (pin == (PinName)NC) return;
gustavatmel 1:9c5af431a1f1 24
gustavatmel 1:9c5af431a1f1 25 int n = pin >> 4;
gustavatmel 1:9c5af431a1f1 26 int bitmask = 1<<(pin & 0xf);
gustavatmel 1:9c5af431a1f1 27 const PinFunc * Pipc_0_func = PIPC_0_tbl;
gustavatmel 1:9c5af431a1f1 28 int pipc_data = 1;
gustavatmel 1:9c5af431a1f1 29
gustavatmel 1:9c5af431a1f1 30 if (gpio_multi_guard != pin) {
gustavatmel 1:9c5af431a1f1 31 if (function == 0) {
gustavatmel 1:9c5af431a1f1 32 // means GPIO mode
gustavatmel 1:9c5af431a1f1 33 *PMC(n) &= ~bitmask;
gustavatmel 1:9c5af431a1f1 34 } else {
gustavatmel 1:9c5af431a1f1 35 // alt-function mode
gustavatmel 1:9c5af431a1f1 36 --function;
gustavatmel 1:9c5af431a1f1 37
gustavatmel 1:9c5af431a1f1 38 if (function & (1 << 2)) { *PFCAE(n) |= bitmask;}else { *PFCAE(n) &= ~bitmask;}
gustavatmel 1:9c5af431a1f1 39 if (function & (1 << 1)) { *PFCE(n) |= bitmask;}else { *PFCE(n) &= ~bitmask;}
gustavatmel 1:9c5af431a1f1 40 if (function & (1 << 0)) { *PFC(n) |= bitmask;}else { *PFC(n) &= ~bitmask;}
gustavatmel 1:9c5af431a1f1 41
gustavatmel 1:9c5af431a1f1 42 while (Pipc_0_func->pin != NC) {
gustavatmel 1:9c5af431a1f1 43 if ((Pipc_0_func->pin == pin) && ((Pipc_0_func->function - 1) == function)) {
gustavatmel 1:9c5af431a1f1 44 pipc_data = 0;
gustavatmel 1:9c5af431a1f1 45 if (Pipc_0_func->pm == 0) {
gustavatmel 1:9c5af431a1f1 46 *PMSR(n) = (bitmask << 16) | 0;
gustavatmel 1:9c5af431a1f1 47 } else if (Pipc_0_func->pm == 1) {
gustavatmel 1:9c5af431a1f1 48 *PMSR(n) = (bitmask << 16) | bitmask;
gustavatmel 1:9c5af431a1f1 49 } else {
gustavatmel 1:9c5af431a1f1 50 // Do Nothing
gustavatmel 1:9c5af431a1f1 51 }
gustavatmel 1:9c5af431a1f1 52 break;
gustavatmel 1:9c5af431a1f1 53 }
gustavatmel 1:9c5af431a1f1 54 Pipc_0_func++;
gustavatmel 1:9c5af431a1f1 55 }
gustavatmel 1:9c5af431a1f1 56 if (pipc_data == 1) {
gustavatmel 1:9c5af431a1f1 57 *PIPC(n) |= bitmask;
gustavatmel 1:9c5af431a1f1 58 } else {
gustavatmel 1:9c5af431a1f1 59 *PIPC(n) &= ~bitmask;
gustavatmel 1:9c5af431a1f1 60 }
gustavatmel 1:9c5af431a1f1 61
gustavatmel 1:9c5af431a1f1 62 if (P1_0 <= pin && pin <= P1_7 && function == 0) {
gustavatmel 1:9c5af431a1f1 63 *PBDC(n) |= bitmask;
gustavatmel 1:9c5af431a1f1 64 }
gustavatmel 1:9c5af431a1f1 65 *PMC(n) |= bitmask;
gustavatmel 1:9c5af431a1f1 66 }
gustavatmel 1:9c5af431a1f1 67 } else {
gustavatmel 1:9c5af431a1f1 68 gpio_multi_guard = (PinName)NC;
gustavatmel 1:9c5af431a1f1 69 }
gustavatmel 1:9c5af431a1f1 70 }
gustavatmel 1:9c5af431a1f1 71
gustavatmel 1:9c5af431a1f1 72 void pin_mode(PinName pin, PinMode mode) {
gustavatmel 1:9c5af431a1f1 73 // if (pin == (PinName)NC) { return; }
gustavatmel 1:9c5af431a1f1 74 }