Gordon Craig / mbed-dev

Important changes to repositories hosted on mbed.com

Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.

To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.

It is also possible to export all your personal repositories from the account settings page.

Fork of mbed-dev by mbed official

targets/TARGET_Freescale/TARGET_MCUXpresso_MCUS/TARGET_KL27Z/pwmout_api.c@174:ed647f63e28d, 2017-12-19 (annotated)

Committer:
Dollyparton
Date:
Tue Dec 19 12:50:13 2017 +0000
Revision:
174:ed647f63e28d
Parent:
154:37f96f9d4de2 
Added RAW socket.

Who changed what in which revision?

UserRevisionLine numberNew contents of line
<> 154:37f96f9d4de2 1 /* mbed Microcontroller Library
<> 154:37f96f9d4de2 2 * Copyright (c) 2006-2013 ARM Limited
<> 154:37f96f9d4de2 3 *
<> 154:37f96f9d4de2 4 * Licensed under the Apache License, Version 2.0 (the "License");
<> 154:37f96f9d4de2 5 * you may not use this file except in compliance with the License.
<> 154:37f96f9d4de2 6 * You may obtain a copy of the License at
<> 154:37f96f9d4de2 7 *
<> 154:37f96f9d4de2 8 * http://www.apache.org/licenses/LICENSE-2.0
<> 154:37f96f9d4de2 9 *
<> 154:37f96f9d4de2 10 * Unless required by applicable law or agreed to in writing, software
<> 154:37f96f9d4de2 11 * distributed under the License is distributed on an "AS IS" BASIS,
<> 154:37f96f9d4de2 12 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
<> 154:37f96f9d4de2 13 * See the License for the specific language governing permissions and
<> 154:37f96f9d4de2 14 * limitations under the License.
<> 154:37f96f9d4de2 15 */
<> 154:37f96f9d4de2 16 #include "mbed_assert.h"
<> 154:37f96f9d4de2 17 #include "pwmout_api.h"
<> 154:37f96f9d4de2 18
<> 154:37f96f9d4de2 19 #if DEVICE_PWMOUT
<> 154:37f96f9d4de2 20
<> 154:37f96f9d4de2 21 #include "cmsis.h"
<> 154:37f96f9d4de2 22 #include "pinmap.h"
<> 154:37f96f9d4de2 23 #include "fsl_tpm.h"
<> 154:37f96f9d4de2 24 #include "PeripheralPins.h"
<> 154:37f96f9d4de2 25
<> 154:37f96f9d4de2 26 static float pwm_clock_mhz;
<> 154:37f96f9d4de2 27 /* Array of TPM peripheral base address. */
<> 154:37f96f9d4de2 28 static TPM_Type *const tpm_addrs[] = TPM_BASE_PTRS;
<> 154:37f96f9d4de2 29
<> 154:37f96f9d4de2 30 void pwmout_init(pwmout_t* obj, PinName pin)
<> 154:37f96f9d4de2 31 {
<> 154:37f96f9d4de2 32 PWMName pwm = (PWMName)pinmap_peripheral(pin, PinMap_PWM);
<> 154:37f96f9d4de2 33 MBED_ASSERT(pwm != (PWMName)NC);
<> 154:37f96f9d4de2 34
<> 154:37f96f9d4de2 35 obj->pwm_name = pwm;
<> 154:37f96f9d4de2 36
<> 154:37f96f9d4de2 37 uint32_t pwm_base_clock;
<> 154:37f96f9d4de2 38
<> 154:37f96f9d4de2 39 /* Set the TPM clock source to be IRC 48M */
<> 154:37f96f9d4de2 40 CLOCK_SetTpmClock(1U);
<> 154:37f96f9d4de2 41 pwm_base_clock = CLOCK_GetFreq(kCLOCK_McgIrc48MClk);
<> 154:37f96f9d4de2 42 float clkval = (float)pwm_base_clock / 1000000.0f;
<> 154:37f96f9d4de2 43 uint32_t clkdiv = 0;
<> 154:37f96f9d4de2 44 while (clkval > 1) {
<> 154:37f96f9d4de2 45 clkdiv++;
<> 154:37f96f9d4de2 46 clkval /= 2.0f;
<> 154:37f96f9d4de2 47 if (clkdiv == 7) {
<> 154:37f96f9d4de2 48 break;
<> 154:37f96f9d4de2 49 }
<> 154:37f96f9d4de2 50 }
<> 154:37f96f9d4de2 51
<> 154:37f96f9d4de2 52 pwm_clock_mhz = clkval;
<> 154:37f96f9d4de2 53 uint32_t channel = pwm & 0xF;
<> 154:37f96f9d4de2 54 uint32_t instance = pwm >> TPM_SHIFT;
<> 154:37f96f9d4de2 55 tpm_config_t tpmInfo;
<> 154:37f96f9d4de2 56
<> 154:37f96f9d4de2 57 TPM_GetDefaultConfig(&tpmInfo);
<> 154:37f96f9d4de2 58 tpmInfo.prescale = (tpm_clock_prescale_t)clkdiv;
<> 154:37f96f9d4de2 59 /* Initialize TPM module */
<> 154:37f96f9d4de2 60 TPM_Init(tpm_addrs[instance], &tpmInfo);
<> 154:37f96f9d4de2 61
<> 154:37f96f9d4de2 62 tpm_chnl_pwm_signal_param_t config = {
<> 154:37f96f9d4de2 63 .chnlNumber = (tpm_chnl_t)channel,
<> 154:37f96f9d4de2 64 .level = kTPM_HighTrue,
<> 154:37f96f9d4de2 65 .dutyCyclePercent = 0,
<> 154:37f96f9d4de2 66 };
<> 154:37f96f9d4de2 67 // default to 20ms: standard for servos, and fine for e.g. brightness control
<> 154:37f96f9d4de2 68 TPM_SetupPwm(tpm_addrs[instance], &config, 1, kTPM_EdgeAlignedPwm, 50, pwm_base_clock);
<> 154:37f96f9d4de2 69
<> 154:37f96f9d4de2 70 TPM_StartTimer(tpm_addrs[instance], kTPM_SystemClock);
<> 154:37f96f9d4de2 71
<> 154:37f96f9d4de2 72 // Wire pinout
<> 154:37f96f9d4de2 73 pinmap_pinout(pin, PinMap_PWM);
<> 154:37f96f9d4de2 74 }
<> 154:37f96f9d4de2 75
<> 154:37f96f9d4de2 76 void pwmout_free(pwmout_t* obj)
<> 154:37f96f9d4de2 77 {
<> 154:37f96f9d4de2 78 TPM_Deinit(tpm_addrs[obj->pwm_name >> TPM_SHIFT]);
<> 154:37f96f9d4de2 79 }
<> 154:37f96f9d4de2 80
<> 154:37f96f9d4de2 81 void pwmout_write(pwmout_t* obj, float value)
<> 154:37f96f9d4de2 82 {
<> 154:37f96f9d4de2 83 if (value < 0.0f) {
<> 154:37f96f9d4de2 84 value = 0.0f;
<> 154:37f96f9d4de2 85 } else if (value > 1.0f) {
<> 154:37f96f9d4de2 86 value = 1.0f;
<> 154:37f96f9d4de2 87 }
<> 154:37f96f9d4de2 88
<> 154:37f96f9d4de2 89 TPM_Type *base = tpm_addrs[obj->pwm_name >> TPM_SHIFT];
<> 154:37f96f9d4de2 90 uint16_t mod = base->MOD & TPM_MOD_MOD_MASK;
<> 154:37f96f9d4de2 91 uint32_t new_count = (uint32_t)((float)(mod) * value);
<> 154:37f96f9d4de2 92 // Update of CnV register
<> 154:37f96f9d4de2 93 base->CONTROLS[obj->pwm_name & 0xF].CnV = new_count;
<> 154:37f96f9d4de2 94 base->CNT = 0;
<> 154:37f96f9d4de2 95 }
<> 154:37f96f9d4de2 96
<> 154:37f96f9d4de2 97 float pwmout_read(pwmout_t* obj)
<> 154:37f96f9d4de2 98 {
<> 154:37f96f9d4de2 99 TPM_Type *base = tpm_addrs[obj->pwm_name >> TPM_SHIFT];
<> 154:37f96f9d4de2 100 uint16_t count = (base->CONTROLS[obj->pwm_name & 0xF].CnV) & TPM_CnV_VAL_MASK;
<> 154:37f96f9d4de2 101 uint16_t mod = base->MOD & TPM_MOD_MOD_MASK;
<> 154:37f96f9d4de2 102
<> 154:37f96f9d4de2 103 if (mod == 0)
<> 154:37f96f9d4de2 104 return 0.0;
<> 154:37f96f9d4de2 105 float v = (float)(count) / (float)(mod);
<> 154:37f96f9d4de2 106 return (v > 1.0f) ? (1.0f) : (v);
<> 154:37f96f9d4de2 107 }
<> 154:37f96f9d4de2 108
<> 154:37f96f9d4de2 109 void pwmout_period(pwmout_t* obj, float seconds)
<> 154:37f96f9d4de2 110 {
<> 154:37f96f9d4de2 111 pwmout_period_us(obj, seconds * 1000000.0f);
<> 154:37f96f9d4de2 112 }
<> 154:37f96f9d4de2 113
<> 154:37f96f9d4de2 114 void pwmout_period_ms(pwmout_t* obj, int ms)
<> 154:37f96f9d4de2 115 {
<> 154:37f96f9d4de2 116 pwmout_period_us(obj, ms * 1000);
<> 154:37f96f9d4de2 117 }
<> 154:37f96f9d4de2 118
<> 154:37f96f9d4de2 119 // Set the PWM period, keeping the duty cycle the same.
<> 154:37f96f9d4de2 120 void pwmout_period_us(pwmout_t* obj, int us)
<> 154:37f96f9d4de2 121 {
<> 154:37f96f9d4de2 122 TPM_Type *base = tpm_addrs[obj->pwm_name >> TPM_SHIFT];
<> 154:37f96f9d4de2 123 float dc = pwmout_read(obj);
<> 154:37f96f9d4de2 124
<> 154:37f96f9d4de2 125 // Stop TPM clock to ensure instant update of MOD register
<> 154:37f96f9d4de2 126 base->MOD = TPM_MOD_MOD((pwm_clock_mhz * (float)us) - 1);
<> 154:37f96f9d4de2 127 pwmout_write(obj, dc);
<> 154:37f96f9d4de2 128 }
<> 154:37f96f9d4de2 129
<> 154:37f96f9d4de2 130 void pwmout_pulsewidth(pwmout_t* obj, float seconds)
<> 154:37f96f9d4de2 131 {
<> 154:37f96f9d4de2 132 pwmout_pulsewidth_us(obj, seconds * 1000000.0f);
<> 154:37f96f9d4de2 133 }
<> 154:37f96f9d4de2 134
<> 154:37f96f9d4de2 135 void pwmout_pulsewidth_ms(pwmout_t* obj, int ms)
<> 154:37f96f9d4de2 136 {
<> 154:37f96f9d4de2 137 pwmout_pulsewidth_us(obj, ms * 1000);
<> 154:37f96f9d4de2 138 }
<> 154:37f96f9d4de2 139
<> 154:37f96f9d4de2 140 void pwmout_pulsewidth_us(pwmout_t* obj, int us)
<> 154:37f96f9d4de2 141 {
<> 154:37f96f9d4de2 142 TPM_Type *base = tpm_addrs[obj->pwm_name >> TPM_SHIFT];
<> 154:37f96f9d4de2 143 uint32_t value = (uint32_t)(pwm_clock_mhz * (float)us);
<> 154:37f96f9d4de2 144
<> 154:37f96f9d4de2 145 // Update of CnV register
<> 154:37f96f9d4de2 146 base->CONTROLS[obj->pwm_name & 0xF].CnV = value;
<> 154:37f96f9d4de2 147 }
<> 154:37f96f9d4de2 148
<> 154:37f96f9d4de2 149 #endif