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-2013 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 "pinmap.h"
sahilmgandhi 18:6a4db94011d3 17 #include "mbed_error.h"
sahilmgandhi 18:6a4db94011d3 18 #include "gpio_addrdefine.h"
sahilmgandhi 18:6a4db94011d3 19
sahilmgandhi 18:6a4db94011d3 20 PinName gpio_multi_guard = (PinName)NC; /* If set pin name here, setting of the "pin" is just one time */
sahilmgandhi 18:6a4db94011d3 21
sahilmgandhi 18:6a4db94011d3 22 typedef struct {
sahilmgandhi 18:6a4db94011d3 23 PinName pin;
sahilmgandhi 18:6a4db94011d3 24 int function;
sahilmgandhi 18:6a4db94011d3 25 int pm;
sahilmgandhi 18:6a4db94011d3 26 } PinFunc;
sahilmgandhi 18:6a4db94011d3 27
sahilmgandhi 18:6a4db94011d3 28 #ifdef MAX_PERI
sahilmgandhi 18:6a4db94011d3 29 static const PinFunc PIPC_0_tbl[] = {
sahilmgandhi 18:6a4db94011d3 30 // pin func pm
sahilmgandhi 18:6a4db94011d3 31 {P4_0 , 2 , -1}, /* TIOC0A */
sahilmgandhi 18:6a4db94011d3 32 {P5_0 , 6 , -1}, /* TIOC0A */
sahilmgandhi 18:6a4db94011d3 33 {P7_0 , 7 , -1}, /* TIOC0A */
sahilmgandhi 18:6a4db94011d3 34 {P4_1 , 2 , -1}, /* TIOC0B */
sahilmgandhi 18:6a4db94011d3 35 {P5_1 , 6 , -1}, /* TIOC0B */
sahilmgandhi 18:6a4db94011d3 36 {P7_1 , 7 , -1}, /* TIOC0B */
sahilmgandhi 18:6a4db94011d3 37 {P4_2 , 2 , -1}, /* TIOC0C */
sahilmgandhi 18:6a4db94011d3 38 {P5_5 , 6 , -1}, /* TIOC0C */
sahilmgandhi 18:6a4db94011d3 39 {P7_2 , 7 , -1}, /* TIOC0C */
sahilmgandhi 18:6a4db94011d3 40 {P4_3 , 2 , -1}, /* TIOC0D */
sahilmgandhi 18:6a4db94011d3 41 {P5_7 , 6 , -1}, /* TIOC0D */
sahilmgandhi 18:6a4db94011d3 42 {P7_3 , 7 , -1}, /* TIOC0D */
sahilmgandhi 18:6a4db94011d3 43 {P2_11 , 5 , -1}, /* TIOC1A */
sahilmgandhi 18:6a4db94011d3 44 {P6_0 , 5 , -1}, /* TIOC1A */
sahilmgandhi 18:6a4db94011d3 45 {P7_4 , 7 , -1}, /* TIOC1A */
sahilmgandhi 18:6a4db94011d3 46 {P8_8 , 5 , -1}, /* TIOC1A */
sahilmgandhi 18:6a4db94011d3 47 {P9_7 , 4 , -1}, /* TIOC1A */
sahilmgandhi 18:6a4db94011d3 48 {P2_12 , 8 , -1}, /* TIOC1B */
sahilmgandhi 18:6a4db94011d3 49 {P5_2 , 6 , -1}, /* TIOC1B */
sahilmgandhi 18:6a4db94011d3 50 {P6_1 , 5 , -1}, /* TIOC1B */
sahilmgandhi 18:6a4db94011d3 51 {P7_5 , 7 , -1}, /* TIOC1B */
sahilmgandhi 18:6a4db94011d3 52 {P8_9 , 5 , -1}, /* TIOC1B */
sahilmgandhi 18:6a4db94011d3 53 {P2_1 , 6 , -1}, /* TIOC2A */
sahilmgandhi 18:6a4db94011d3 54 {P6_2 , 6 , -1}, /* TIOC2A */
sahilmgandhi 18:6a4db94011d3 55 {P7_6 , 7 , -1}, /* TIOC2A */
sahilmgandhi 18:6a4db94011d3 56 {P8_14 , 4 , -1}, /* TIOC2A */
sahilmgandhi 18:6a4db94011d3 57 {P2_2 , 6 , -1}, /* TIOC2B */
sahilmgandhi 18:6a4db94011d3 58 {P6_3 , 6 , -1}, /* TIOC2B */
sahilmgandhi 18:6a4db94011d3 59 {P7_7 , 7 , -1}, /* TIOC2B */
sahilmgandhi 18:6a4db94011d3 60 {P8_15 , 4 , -1}, /* TIOC2B */
sahilmgandhi 18:6a4db94011d3 61 {P3_4 , 6 , -1}, /* TIOC3A */
sahilmgandhi 18:6a4db94011d3 62 {P7_8 , 7 , -1}, /* TIOC3A */
sahilmgandhi 18:6a4db94011d3 63 {P8_10 , 4 , -1}, /* TIOC3A */
sahilmgandhi 18:6a4db94011d3 64 {P3_5 , 6 , -1}, /* TIOC3B */
sahilmgandhi 18:6a4db94011d3 65 {P7_9 , 7 , -1}, /* TIOC3B */
sahilmgandhi 18:6a4db94011d3 66 {P8_11 , 4 , -1}, /* TIOC3B */
sahilmgandhi 18:6a4db94011d3 67 {P3_6 , 6 , -1}, /* TIOC3C */
sahilmgandhi 18:6a4db94011d3 68 {P5_3 , 6 , -1}, /* TIOC3C */
sahilmgandhi 18:6a4db94011d3 69 {P7_10 , 7 , -1}, /* TIOC3C */
sahilmgandhi 18:6a4db94011d3 70 {P8_12 , 4 , -1}, /* TIOC3C */
sahilmgandhi 18:6a4db94011d3 71 {P3_7 , 6 , -1}, /* TIOC3D */
sahilmgandhi 18:6a4db94011d3 72 {P5_4 , 6 , -1}, /* TIOC3D */
sahilmgandhi 18:6a4db94011d3 73 {P7_11 , 7 , -1}, /* TIOC3D */
sahilmgandhi 18:6a4db94011d3 74 {P8_13 , 4 , -1}, /* TIOC3D */
sahilmgandhi 18:6a4db94011d3 75 {P3_8 , 6 , -1}, /* TIOC4A */
sahilmgandhi 18:6a4db94011d3 76 {P4_4 , 3 , -1}, /* TIOC4A */
sahilmgandhi 18:6a4db94011d3 77 {P7_12 , 7 , -1}, /* TIOC4A */
sahilmgandhi 18:6a4db94011d3 78 {P3_9 , 6 , -1}, /* TIOC4B */
sahilmgandhi 18:6a4db94011d3 79 {P4_5 , 3 , -1}, /* TIOC4B */
sahilmgandhi 18:6a4db94011d3 80 {P7_13 , 7 , -1}, /* TIOC4B */
sahilmgandhi 18:6a4db94011d3 81 {P3_10 , 6 , -1}, /* TIOC4C */
sahilmgandhi 18:6a4db94011d3 82 {P4_6 , 3 , -1}, /* TIOC4C */
sahilmgandhi 18:6a4db94011d3 83 {P7_14 , 7 , -1}, /* TIOC4C */
sahilmgandhi 18:6a4db94011d3 84 {P3_11 , 6 , -1}, /* TIOC4D */
sahilmgandhi 18:6a4db94011d3 85 {P4_7 , 3 , -1}, /* TIOC4D */
sahilmgandhi 18:6a4db94011d3 86 {P7_15 , 7 , -1}, /* TIOC4D */
sahilmgandhi 18:6a4db94011d3 87 {P5_7 , 1 , 1 }, /* TXOUT0M */
sahilmgandhi 18:6a4db94011d3 88 {P5_6 , 1 , 1 }, /* TXOUT0P */
sahilmgandhi 18:6a4db94011d3 89 {P5_5 , 1 , 1 }, /* TXOUT1M */
sahilmgandhi 18:6a4db94011d3 90 {P5_4 , 1 , 1 }, /* TXOUT1P */
sahilmgandhi 18:6a4db94011d3 91 {P5_3 , 1 , 1 }, /* TXOUT2M */
sahilmgandhi 18:6a4db94011d3 92 {P5_2 , 1 , 1 }, /* TXOUT2P */
sahilmgandhi 18:6a4db94011d3 93 {P5_1 , 1 , 1 }, /* TXCLKOUTM */
sahilmgandhi 18:6a4db94011d3 94 {P5_0 , 1 , 1 }, /* TXCLKOUTP */
sahilmgandhi 18:6a4db94011d3 95 {P2_11 , 4 , 0 }, /* SSITxD0 */
sahilmgandhi 18:6a4db94011d3 96 {P4_7 , 5 , 0 }, /* SSITxD0 */
sahilmgandhi 18:6a4db94011d3 97 {P7_4 , 6 , 0 }, /* SSITxD1 */
sahilmgandhi 18:6a4db94011d3 98 {P4_15 , 6 , 0 }, /* SSITxD3 */
sahilmgandhi 18:6a4db94011d3 99 {P7_11 , 2 , 0 }, /* SSITxD3 */
sahilmgandhi 18:6a4db94011d3 100 {P2_7 , 4 , 0 }, /* SSITxD5 */
sahilmgandhi 18:6a4db94011d3 101 {P4_11 , 5 , 0 }, /* SSITxD5 */
sahilmgandhi 18:6a4db94011d3 102 {P8_10 , 8 , 0 }, /* SSITxD5 */
sahilmgandhi 18:6a4db94011d3 103 {P3_7 , 8 , 0 }, /* WDTOVF */
sahilmgandhi 18:6a4db94011d3 104 {NC , 0 , -1}
sahilmgandhi 18:6a4db94011d3 105 };
sahilmgandhi 18:6a4db94011d3 106 #else
sahilmgandhi 18:6a4db94011d3 107 static const PinFunc PIPC_0_tbl[] = {
sahilmgandhi 18:6a4db94011d3 108 // pin func pm
sahilmgandhi 18:6a4db94011d3 109 {P4_0 , 2 , -1}, // TIOC0A
sahilmgandhi 18:6a4db94011d3 110 {P5_0 , 6 , -1}, // TIOC0A
sahilmgandhi 18:6a4db94011d3 111 {P4_2 , 2 , -1}, // TIOC0C
sahilmgandhi 18:6a4db94011d3 112 {P5_5 , 6 , -1}, // TIOC0C
sahilmgandhi 18:6a4db94011d3 113 //
sahilmgandhi 18:6a4db94011d3 114 {P8_14 , 4 , -1}, // TIOC2A
sahilmgandhi 18:6a4db94011d3 115 //
sahilmgandhi 18:6a4db94011d3 116 {P8_10 , 4 , -1}, // TIOC3A
sahilmgandhi 18:6a4db94011d3 117 {P5_3 , 6 , -1}, // TIOC3C
sahilmgandhi 18:6a4db94011d3 118 {P8_12 , 4 , -1}, // TIOC3C
sahilmgandhi 18:6a4db94011d3 119 //
sahilmgandhi 18:6a4db94011d3 120 {P3_8 , 6 , -1}, // TIOC4A
sahilmgandhi 18:6a4db94011d3 121 {P4_4 , 3 , -1}, // TIOC4A
sahilmgandhi 18:6a4db94011d3 122 {P3_10 , 6 , -1}, // TIOC4C
sahilmgandhi 18:6a4db94011d3 123 {P4_6 , 3 , -1}, // TIOC4C
sahilmgandhi 18:6a4db94011d3 124 //
sahilmgandhi 18:6a4db94011d3 125 {P5_7 , 1 , 1 }, // TXOUT0M
sahilmgandhi 18:6a4db94011d3 126 {P5_6 , 1 , 1 }, // TXOUT0P
sahilmgandhi 18:6a4db94011d3 127 {P5_5 , 1 , 1 }, // TXOUT1M
sahilmgandhi 18:6a4db94011d3 128 {P5_4 , 1 , 1 }, // TXOUT1P
sahilmgandhi 18:6a4db94011d3 129 {P5_3 , 1 , 1 }, // TXOUT2M
sahilmgandhi 18:6a4db94011d3 130 {P5_2 , 1 , 1 }, // TXOUT2P
sahilmgandhi 18:6a4db94011d3 131 {P5_1 , 1 , 1 }, // TXCLKOUTM
sahilmgandhi 18:6a4db94011d3 132 {P5_0 , 1 , 1 }, // TXCLKOUTP
sahilmgandhi 18:6a4db94011d3 133 {P4_7 , 5 , 0 }, // SSITxD0
sahilmgandhi 18:6a4db94011d3 134 {P8_10 , 8 , 0 }, // SSITxD5
sahilmgandhi 18:6a4db94011d3 135 {P3_7 , 8 , 0 }, // WDTOVF
sahilmgandhi 18:6a4db94011d3 136 {NC , 0 , -1}
sahilmgandhi 18:6a4db94011d3 137 };
sahilmgandhi 18:6a4db94011d3 138 #endif
sahilmgandhi 18:6a4db94011d3 139
sahilmgandhi 18:6a4db94011d3 140 void pin_function(PinName pin, int function) {
sahilmgandhi 18:6a4db94011d3 141 if (pin == (PinName)NC) return;
sahilmgandhi 18:6a4db94011d3 142
sahilmgandhi 18:6a4db94011d3 143 int n = pin >> 4;
sahilmgandhi 18:6a4db94011d3 144 int bitmask = 1<<(pin & 0xf);
sahilmgandhi 18:6a4db94011d3 145 const PinFunc * Pipc_0_func = PIPC_0_tbl;
sahilmgandhi 18:6a4db94011d3 146 int pipc_data = 1;
sahilmgandhi 18:6a4db94011d3 147
sahilmgandhi 18:6a4db94011d3 148 if (gpio_multi_guard != pin) {
sahilmgandhi 18:6a4db94011d3 149 if (function == 0) {
sahilmgandhi 18:6a4db94011d3 150 // means GPIO mode
sahilmgandhi 18:6a4db94011d3 151 *PMC(n) &= ~bitmask;
sahilmgandhi 18:6a4db94011d3 152 } else {
sahilmgandhi 18:6a4db94011d3 153 // alt-function mode
sahilmgandhi 18:6a4db94011d3 154 --function;
sahilmgandhi 18:6a4db94011d3 155
sahilmgandhi 18:6a4db94011d3 156 if (function & (1 << 2)) { *PFCAE(n) |= bitmask;}else { *PFCAE(n) &= ~bitmask;}
sahilmgandhi 18:6a4db94011d3 157 if (function & (1 << 1)) { *PFCE(n) |= bitmask;}else { *PFCE(n) &= ~bitmask;}
sahilmgandhi 18:6a4db94011d3 158 if (function & (1 << 0)) { *PFC(n) |= bitmask;}else { *PFC(n) &= ~bitmask;}
sahilmgandhi 18:6a4db94011d3 159
sahilmgandhi 18:6a4db94011d3 160 while (Pipc_0_func->pin != NC) {
sahilmgandhi 18:6a4db94011d3 161 if ((Pipc_0_func->pin == pin) && ((Pipc_0_func->function - 1) == function)) {
sahilmgandhi 18:6a4db94011d3 162 pipc_data = 0;
sahilmgandhi 18:6a4db94011d3 163 if (Pipc_0_func->pm == 0) {
sahilmgandhi 18:6a4db94011d3 164 *PMSR(n) = (bitmask << 16) | 0;
sahilmgandhi 18:6a4db94011d3 165 } else if (Pipc_0_func->pm == 1) {
sahilmgandhi 18:6a4db94011d3 166 *PMSR(n) = (bitmask << 16) | bitmask;
sahilmgandhi 18:6a4db94011d3 167 } else {
sahilmgandhi 18:6a4db94011d3 168 // Do Nothing
sahilmgandhi 18:6a4db94011d3 169 }
sahilmgandhi 18:6a4db94011d3 170 break;
sahilmgandhi 18:6a4db94011d3 171 }
sahilmgandhi 18:6a4db94011d3 172 Pipc_0_func++;
sahilmgandhi 18:6a4db94011d3 173 }
sahilmgandhi 18:6a4db94011d3 174 if (pipc_data == 1) {
sahilmgandhi 18:6a4db94011d3 175 *PIPC(n) |= bitmask;
sahilmgandhi 18:6a4db94011d3 176 } else {
sahilmgandhi 18:6a4db94011d3 177 *PIPC(n) &= ~bitmask;
sahilmgandhi 18:6a4db94011d3 178 }
sahilmgandhi 18:6a4db94011d3 179
sahilmgandhi 18:6a4db94011d3 180 if (P1_0 <= pin && pin <= P1_7 && function == 0) {
sahilmgandhi 18:6a4db94011d3 181 *PBDC(n) |= bitmask;
sahilmgandhi 18:6a4db94011d3 182 }
sahilmgandhi 18:6a4db94011d3 183 *PMC(n) |= bitmask;
sahilmgandhi 18:6a4db94011d3 184 }
sahilmgandhi 18:6a4db94011d3 185 } else {
sahilmgandhi 18:6a4db94011d3 186 gpio_multi_guard = (PinName)NC;
sahilmgandhi 18:6a4db94011d3 187 }
sahilmgandhi 18:6a4db94011d3 188 }
sahilmgandhi 18:6a4db94011d3 189
sahilmgandhi 18:6a4db94011d3 190 void pin_mode(PinName pin, PinMode mode) {
sahilmgandhi 18:6a4db94011d3 191 // if (pin == (PinName)NC) { return; }
sahilmgandhi 18:6a4db94011d3 192 }