mbed SDK library sources

Fork of mbed-src by mbed official

Development branch of the mbed library sources. This library is kept in synch with the latest changes from the mbed SDK and it is not guaranteed to work.

If you are looking for a stable and tested release, please import one of the official mbed library releases:

Import librarymbed

The official Mbed 2 C/C++ SDK provides the software platform and libraries to build your applications.

Committer:
mbed_official
Date:
Wed Sep 25 10:30:04 2013 +0100
Revision:
30:91c1d09ada54
Synchronized with git revision 8f57c1e84759991fa81ede0da2b4aabe8530fa09

Who changed what in which revision?

UserRevisionLine numberNew contents of line
mbed_official 30:91c1d09ada54 1 /* mbed Microcontroller Library
mbed_official 30:91c1d09ada54 2 * Copyright (c) 2006-2013 ARM Limited
mbed_official 30:91c1d09ada54 3 *
mbed_official 30:91c1d09ada54 4 * Licensed under the Apache License, Version 2.0 (the "License");
mbed_official 30:91c1d09ada54 5 * you may not use this file except in compliance with the License.
mbed_official 30:91c1d09ada54 6 * You may obtain a copy of the License at
mbed_official 30:91c1d09ada54 7 *
mbed_official 30:91c1d09ada54 8 * http://www.apache.org/licenses/LICENSE-2.0
mbed_official 30:91c1d09ada54 9 *
mbed_official 30:91c1d09ada54 10 * Unless required by applicable law or agreed to in writing, software
mbed_official 30:91c1d09ada54 11 * distributed under the License is distributed on an "AS IS" BASIS,
mbed_official 30:91c1d09ada54 12 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
mbed_official 30:91c1d09ada54 13 * See the License for the specific language governing permissions and
mbed_official 30:91c1d09ada54 14 * limitations under the License.
mbed_official 30:91c1d09ada54 15 */
mbed_official 30:91c1d09ada54 16 #include "pwmout_api.h"
mbed_official 30:91c1d09ada54 17 #include "cmsis.h"
mbed_official 30:91c1d09ada54 18 #include "pinmap.h"
mbed_official 30:91c1d09ada54 19 #include "error.h"
mbed_official 30:91c1d09ada54 20
mbed_official 30:91c1d09ada54 21 #define TCR_CNT_EN 0x00000001
mbed_official 30:91c1d09ada54 22 #define TCR_RESET 0x00000002
mbed_official 30:91c1d09ada54 23
mbed_official 30:91c1d09ada54 24 /* To have a PWM where we can change both the period and the duty cycle,
mbed_official 30:91c1d09ada54 25 * we need an entire timer. With the following conventions:
mbed_official 30:91c1d09ada54 26 * * MR3 is used for the PWM period
mbed_official 30:91c1d09ada54 27 * * MR0, MR1, MR2 are used for the duty cycle
mbed_official 30:91c1d09ada54 28 */
mbed_official 30:91c1d09ada54 29 static const PinMap PinMap_PWM[] = {
mbed_official 30:91c1d09ada54 30 /* CT16B0 */
mbed_official 30:91c1d09ada54 31 {P0_8 , PWM_1, 0x02}, /* MR0 */
mbed_official 30:91c1d09ada54 32 {P0_9 , PWM_2, 0x02}, /* MR1 */
mbed_official 30:91c1d09ada54 33 {P0_10, PWM_3, 0x03}, /* MR2 */
mbed_official 30:91c1d09ada54 34
mbed_official 30:91c1d09ada54 35 /* CT16B1 */
mbed_official 30:91c1d09ada54 36 {P1_9 , PWM_4, 0x01}, /* MR0 */
mbed_official 30:91c1d09ada54 37 {P1_10, PWM_5, 0x02}, /* MR1 */
mbed_official 30:91c1d09ada54 38
mbed_official 30:91c1d09ada54 39 /* CT32B0 */
mbed_official 30:91c1d09ada54 40 {P1_6 , PWM_6, 0x02}, /* MR0 */
mbed_official 30:91c1d09ada54 41 {P1_7 , PWM_7, 0x02}, /* MR1 */
mbed_official 30:91c1d09ada54 42 {P0_1 , PWM_8, 0x02}, /* MR2 */
mbed_official 30:91c1d09ada54 43
mbed_official 30:91c1d09ada54 44 /* CT32B1 */
mbed_official 30:91c1d09ada54 45 {P1_1 , PWM_9 ,0x03}, /* MR0 */
mbed_official 30:91c1d09ada54 46 {P1_2 , PWM_10,0x03}, /* MR1 */
mbed_official 30:91c1d09ada54 47 {P1_3 , PWM_11,0x03}, /* MR2 */
mbed_official 30:91c1d09ada54 48
mbed_official 30:91c1d09ada54 49 {NC , NC ,0x00}
mbed_official 30:91c1d09ada54 50 };
mbed_official 30:91c1d09ada54 51
mbed_official 30:91c1d09ada54 52 typedef struct {
mbed_official 30:91c1d09ada54 53 uint8_t timer;
mbed_official 30:91c1d09ada54 54 uint8_t mr;
mbed_official 30:91c1d09ada54 55 } timer_mr;
mbed_official 30:91c1d09ada54 56
mbed_official 30:91c1d09ada54 57 static timer_mr pwm_timer_map[11] = {
mbed_official 30:91c1d09ada54 58 {0, 0}, /* CT16B0, MR0 */
mbed_official 30:91c1d09ada54 59 {0, 1}, /* CT16B0, MR1 */
mbed_official 30:91c1d09ada54 60 {0, 2}, /* CT16B0, MR2 */
mbed_official 30:91c1d09ada54 61
mbed_official 30:91c1d09ada54 62 {1, 0}, /* CT16B1, MR0 */
mbed_official 30:91c1d09ada54 63 {1, 1}, /* CT16B1, MR1 */
mbed_official 30:91c1d09ada54 64
mbed_official 30:91c1d09ada54 65 {2, 0}, /* CT32B0, MR0 */
mbed_official 30:91c1d09ada54 66 {2, 1}, /* CT32B0, MR1 */
mbed_official 30:91c1d09ada54 67 {2, 2}, /* CT32B0, MR2 */
mbed_official 30:91c1d09ada54 68
mbed_official 30:91c1d09ada54 69 {3, 0}, /* CT32B1, MR0 */
mbed_official 30:91c1d09ada54 70 {3, 1}, /* CT32B1, MR1 */
mbed_official 30:91c1d09ada54 71 {3, 2} /* CT32B1, MR2 */
mbed_official 30:91c1d09ada54 72 };
mbed_official 30:91c1d09ada54 73
mbed_official 30:91c1d09ada54 74 static LPC_TMR_TypeDef *Timers[4] = {
mbed_official 30:91c1d09ada54 75 LPC_TMR16B0, LPC_TMR16B1,
mbed_official 30:91c1d09ada54 76 LPC_TMR32B0, LPC_TMR32B1
mbed_official 30:91c1d09ada54 77 };
mbed_official 30:91c1d09ada54 78
mbed_official 30:91c1d09ada54 79 static unsigned int pwm_clock_mhz;
mbed_official 30:91c1d09ada54 80
mbed_official 30:91c1d09ada54 81 void pwmout_init(pwmout_t* obj, PinName pin) {
mbed_official 30:91c1d09ada54 82 // determine the channel
mbed_official 30:91c1d09ada54 83 PWMName pwm = (PWMName)pinmap_peripheral(pin, PinMap_PWM);
mbed_official 30:91c1d09ada54 84 if (pwm == (uint32_t)NC)
mbed_official 30:91c1d09ada54 85 error("PwmOut pin mapping failed");
mbed_official 30:91c1d09ada54 86
mbed_official 30:91c1d09ada54 87 obj->pwm = pwm;
mbed_official 30:91c1d09ada54 88
mbed_official 30:91c1d09ada54 89 // Timer registers
mbed_official 30:91c1d09ada54 90 timer_mr tid = pwm_timer_map[pwm];
mbed_official 30:91c1d09ada54 91 LPC_TMR_TypeDef *timer = Timers[tid.timer];
mbed_official 30:91c1d09ada54 92
mbed_official 30:91c1d09ada54 93 // Disable timer
mbed_official 30:91c1d09ada54 94 timer->TCR = 0;
mbed_official 30:91c1d09ada54 95
mbed_official 30:91c1d09ada54 96 // Power the correspondent timer
mbed_official 30:91c1d09ada54 97 LPC_SYSCON->SYSAHBCLKCTRL |= 1 << (tid.timer + 7);
mbed_official 30:91c1d09ada54 98
mbed_official 30:91c1d09ada54 99 /* Enable PWM function */
mbed_official 30:91c1d09ada54 100 timer->PWMC = (1 << 3)|(1 << 2)|(1 << 1)|(1 << 0);
mbed_official 30:91c1d09ada54 101
mbed_official 30:91c1d09ada54 102 /* Reset Functionality on MR3 controlling the PWM period */
mbed_official 30:91c1d09ada54 103 timer->MCR = 1 << 10;
mbed_official 30:91c1d09ada54 104
mbed_official 30:91c1d09ada54 105 pwm_clock_mhz = SystemCoreClock / 1000000;
mbed_official 30:91c1d09ada54 106
mbed_official 30:91c1d09ada54 107 // default to 20ms: standard for servos, and fine for e.g. brightness control
mbed_official 30:91c1d09ada54 108 pwmout_period_ms(obj, 20);
mbed_official 30:91c1d09ada54 109 pwmout_write (obj, 0);
mbed_official 30:91c1d09ada54 110
mbed_official 30:91c1d09ada54 111 // Wire pinout
mbed_official 30:91c1d09ada54 112 pinmap_pinout(pin, PinMap_PWM);
mbed_official 30:91c1d09ada54 113 }
mbed_official 30:91c1d09ada54 114
mbed_official 30:91c1d09ada54 115 void pwmout_free(pwmout_t* obj) {
mbed_official 30:91c1d09ada54 116 // [TODO]
mbed_official 30:91c1d09ada54 117 }
mbed_official 30:91c1d09ada54 118
mbed_official 30:91c1d09ada54 119 void pwmout_write(pwmout_t* obj, float value) {
mbed_official 30:91c1d09ada54 120 if (value < 0.0f) {
mbed_official 30:91c1d09ada54 121 value = 0.0;
mbed_official 30:91c1d09ada54 122 } else if (value > 1.0f) {
mbed_official 30:91c1d09ada54 123 value = 1.0;
mbed_official 30:91c1d09ada54 124 }
mbed_official 30:91c1d09ada54 125
mbed_official 30:91c1d09ada54 126 timer_mr tid = pwm_timer_map[obj->pwm];
mbed_official 30:91c1d09ada54 127 LPC_TMR_TypeDef *timer = Timers[tid.timer];
mbed_official 30:91c1d09ada54 128 uint32_t t_off = timer->MR3 - (uint32_t)((float)(timer->MR3) * value);
mbed_official 30:91c1d09ada54 129
mbed_official 30:91c1d09ada54 130 timer->TCR = TCR_RESET;
mbed_official 30:91c1d09ada54 131 timer->MR[tid.mr] = t_off;
mbed_official 30:91c1d09ada54 132 timer->TCR = TCR_CNT_EN;
mbed_official 30:91c1d09ada54 133 }
mbed_official 30:91c1d09ada54 134
mbed_official 30:91c1d09ada54 135 float pwmout_read(pwmout_t* obj) {
mbed_official 30:91c1d09ada54 136 timer_mr tid = pwm_timer_map[obj->pwm];
mbed_official 30:91c1d09ada54 137 LPC_TMR_TypeDef *timer = Timers[tid.timer];
mbed_official 30:91c1d09ada54 138
mbed_official 30:91c1d09ada54 139 float v = (float)(timer->MR3 - timer->MR[tid.mr]) / (float)(timer->MR3);
mbed_official 30:91c1d09ada54 140 return (v > 1.0f) ? (1.0f) : (v);
mbed_official 30:91c1d09ada54 141 }
mbed_official 30:91c1d09ada54 142
mbed_official 30:91c1d09ada54 143 void pwmout_period(pwmout_t* obj, float seconds) {
mbed_official 30:91c1d09ada54 144 pwmout_period_us(obj, seconds * 1000000.0f);
mbed_official 30:91c1d09ada54 145 }
mbed_official 30:91c1d09ada54 146
mbed_official 30:91c1d09ada54 147 void pwmout_period_ms(pwmout_t* obj, int ms) {
mbed_official 30:91c1d09ada54 148 pwmout_period_us(obj, ms * 1000);
mbed_official 30:91c1d09ada54 149 }
mbed_official 30:91c1d09ada54 150
mbed_official 30:91c1d09ada54 151 // Set the PWM period, keeping the duty cycle the same.
mbed_official 30:91c1d09ada54 152 void pwmout_period_us(pwmout_t* obj, int us) {
mbed_official 30:91c1d09ada54 153 int i = 0;
mbed_official 30:91c1d09ada54 154 uint32_t period_ticks = pwm_clock_mhz * us;
mbed_official 30:91c1d09ada54 155
mbed_official 30:91c1d09ada54 156 timer_mr tid = pwm_timer_map[obj->pwm];
mbed_official 30:91c1d09ada54 157 LPC_TMR_TypeDef *timer = Timers[tid.timer];
mbed_official 30:91c1d09ada54 158 uint32_t old_period_ticks = timer->MR3;
mbed_official 30:91c1d09ada54 159
mbed_official 30:91c1d09ada54 160 timer->TCR = TCR_RESET;
mbed_official 30:91c1d09ada54 161 timer->MR3 = period_ticks;
mbed_official 30:91c1d09ada54 162
mbed_official 30:91c1d09ada54 163 // Scale the pulse width to preserve the duty ratio
mbed_official 30:91c1d09ada54 164 if (old_period_ticks > 0) {
mbed_official 30:91c1d09ada54 165 for (i=0; i<3; i++) {
mbed_official 30:91c1d09ada54 166 uint32_t t_off = period_ticks - (uint32_t)(((uint64_t)timer->MR[i] * (uint64_t)period_ticks) / (uint64_t)old_period_ticks);
mbed_official 30:91c1d09ada54 167 timer->MR[i] = t_off;
mbed_official 30:91c1d09ada54 168 }
mbed_official 30:91c1d09ada54 169 }
mbed_official 30:91c1d09ada54 170 timer->TCR = TCR_CNT_EN;
mbed_official 30:91c1d09ada54 171 }
mbed_official 30:91c1d09ada54 172
mbed_official 30:91c1d09ada54 173 void pwmout_pulsewidth(pwmout_t* obj, float seconds) {
mbed_official 30:91c1d09ada54 174 pwmout_pulsewidth_us(obj, seconds * 1000000.0f);
mbed_official 30:91c1d09ada54 175 }
mbed_official 30:91c1d09ada54 176
mbed_official 30:91c1d09ada54 177 void pwmout_pulsewidth_ms(pwmout_t* obj, int ms) {
mbed_official 30:91c1d09ada54 178 pwmout_pulsewidth_us(obj, ms * 1000);
mbed_official 30:91c1d09ada54 179 }
mbed_official 30:91c1d09ada54 180
mbed_official 30:91c1d09ada54 181 void pwmout_pulsewidth_us(pwmout_t* obj, int us) {
mbed_official 30:91c1d09ada54 182 uint32_t t_on = (uint32_t)(((uint64_t)SystemCoreClock * (uint64_t)us) / (uint64_t)1000000);
mbed_official 30:91c1d09ada54 183 timer_mr tid = pwm_timer_map[obj->pwm];
mbed_official 30:91c1d09ada54 184 LPC_TMR_TypeDef *timer = Timers[tid.timer];
mbed_official 30:91c1d09ada54 185
mbed_official 30:91c1d09ada54 186 timer->TCR = TCR_RESET;
mbed_official 30:91c1d09ada54 187 if (t_on > timer->MR3) {
mbed_official 30:91c1d09ada54 188 pwmout_period_us(obj, us);
mbed_official 30:91c1d09ada54 189 }
mbed_official 30:91c1d09ada54 190 uint32_t t_off = timer->MR3 - t_on;
mbed_official 30:91c1d09ada54 191 timer->MR[tid.mr] = t_off;
mbed_official 30:91c1d09ada54 192 timer->TCR = TCR_CNT_EN;
mbed_official 30:91c1d09ada54 193 }