mbed-os

Dependents:   cobaLCDJoyMotor_Thread odometry_omni_3roda_v3 odometry_omni_3roda_v1 odometry_omni_3roda_v2 ... more

Committer:
be_bryan
Date:
Mon Dec 11 17:54:04 2017 +0000
Revision:
0:b74591d5ab33
motor ++

Who changed what in which revision?

UserRevisionLine numberNew contents of line
be_bryan 0:b74591d5ab33 1 /* mbed Microcontroller Library
be_bryan 0:b74591d5ab33 2 * Copyright (c) 2006-2013 ARM Limited
be_bryan 0:b74591d5ab33 3 *
be_bryan 0:b74591d5ab33 4 * Licensed under the Apache License, Version 2.0 (the "License");
be_bryan 0:b74591d5ab33 5 * you may not use this file except in compliance with the License.
be_bryan 0:b74591d5ab33 6 * You may obtain a copy of the License at
be_bryan 0:b74591d5ab33 7 *
be_bryan 0:b74591d5ab33 8 * http://www.apache.org/licenses/LICENSE-2.0
be_bryan 0:b74591d5ab33 9 *
be_bryan 0:b74591d5ab33 10 * Unless required by applicable law or agreed to in writing, software
be_bryan 0:b74591d5ab33 11 * distributed under the License is distributed on an "AS IS" BASIS,
be_bryan 0:b74591d5ab33 12 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
be_bryan 0:b74591d5ab33 13 * See the License for the specific language governing permissions and
be_bryan 0:b74591d5ab33 14 * limitations under the License.
be_bryan 0:b74591d5ab33 15 */
be_bryan 0:b74591d5ab33 16 #include <stddef.h>
be_bryan 0:b74591d5ab33 17 #include "us_ticker_api.h"
be_bryan 0:b74591d5ab33 18 #include "PeripheralNames.h"
be_bryan 0:b74591d5ab33 19
be_bryan 0:b74591d5ab33 20 #define US_TICKER_TIMER ((LPC_CTxxBx_Type *)LPC_CT32B1_BASE)
be_bryan 0:b74591d5ab33 21 #define US_TICKER_TIMER_IRQn TIMER_32_1_IRQn
be_bryan 0:b74591d5ab33 22
be_bryan 0:b74591d5ab33 23 int us_ticker_inited = 0;
be_bryan 0:b74591d5ab33 24
be_bryan 0:b74591d5ab33 25 void us_ticker_init(void) {
be_bryan 0:b74591d5ab33 26 if (us_ticker_inited) return;
be_bryan 0:b74591d5ab33 27 us_ticker_inited = 1;
be_bryan 0:b74591d5ab33 28
be_bryan 0:b74591d5ab33 29 LPC_SYSCON->SYSAHBCLKCTRL |= (1<<10); // Clock TIMER_1
be_bryan 0:b74591d5ab33 30 uint32_t PCLK = SystemCoreClock;
be_bryan 0:b74591d5ab33 31
be_bryan 0:b74591d5ab33 32 US_TICKER_TIMER->TCR = 0x2; // reset
be_bryan 0:b74591d5ab33 33
be_bryan 0:b74591d5ab33 34 uint32_t prescale = PCLK / 1000000; // default to 1MHz (1 us ticks)
be_bryan 0:b74591d5ab33 35 US_TICKER_TIMER->PR = prescale - 1;
be_bryan 0:b74591d5ab33 36 US_TICKER_TIMER->TCR = 1; // enable = 1, reset = 0
be_bryan 0:b74591d5ab33 37
be_bryan 0:b74591d5ab33 38 NVIC_SetVector(US_TICKER_TIMER_IRQn, (uint32_t)us_ticker_irq_handler);
be_bryan 0:b74591d5ab33 39 NVIC_EnableIRQ(US_TICKER_TIMER_IRQn);
be_bryan 0:b74591d5ab33 40 }
be_bryan 0:b74591d5ab33 41
be_bryan 0:b74591d5ab33 42 uint32_t us_ticker_read() {
be_bryan 0:b74591d5ab33 43 if (!us_ticker_inited)
be_bryan 0:b74591d5ab33 44 us_ticker_init();
be_bryan 0:b74591d5ab33 45
be_bryan 0:b74591d5ab33 46 return US_TICKER_TIMER->TC;
be_bryan 0:b74591d5ab33 47 }
be_bryan 0:b74591d5ab33 48
be_bryan 0:b74591d5ab33 49 void us_ticker_set_interrupt(timestamp_t timestamp) {
be_bryan 0:b74591d5ab33 50 // set match value
be_bryan 0:b74591d5ab33 51 US_TICKER_TIMER->MR0 = (uint32_t)timestamp;
be_bryan 0:b74591d5ab33 52 // enable match interrupt
be_bryan 0:b74591d5ab33 53 US_TICKER_TIMER->MCR |= 1;
be_bryan 0:b74591d5ab33 54 }
be_bryan 0:b74591d5ab33 55
be_bryan 0:b74591d5ab33 56 void us_ticker_fire_interrupt(void)
be_bryan 0:b74591d5ab33 57 {
be_bryan 0:b74591d5ab33 58 NVIC_SetPendingIRQ(US_TICKER_TIMER_IRQn);
be_bryan 0:b74591d5ab33 59 }
be_bryan 0:b74591d5ab33 60
be_bryan 0:b74591d5ab33 61 void us_ticker_disable_interrupt(void) {
be_bryan 0:b74591d5ab33 62 US_TICKER_TIMER->MCR &= ~1;
be_bryan 0:b74591d5ab33 63 }
be_bryan 0:b74591d5ab33 64
be_bryan 0:b74591d5ab33 65 void us_ticker_clear_interrupt(void) {
be_bryan 0:b74591d5ab33 66 US_TICKER_TIMER->IR = 1;
be_bryan 0:b74591d5ab33 67 }