ARMmbed
/
mbed-os
mirror of https://github.com/ARMmbed/mbed-os.git
1
0
Fork 0
Code Issues Projects Releases Wiki Activity

Add terminal defines of PWM and fix a bug that period can not be changed. 

Fix a bug as below.
- Period can not be changed.
   Restructions: 1. The upper limits is 491us
                             2. Change all period of the same channel when changing period.
pull/784/head
Masao Hamanaka 2014-12-12 14:26:33 +09:00
parent fc7e246596
commit 8e3b9aba75
3 changed files with 175 additions and 106 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

22
libraries/mbed/targets/hal/TARGET_RENESAS/TARGET_RZ_A1H/PeripheralNames.h
View File

@ -50,16 +50,20 @@ typedef enum {
PWM2H, PWM2H,
} PWMType; } PWMType;
#define PTM_SHIFT 8
typedef enum { typedef enum {
PWM0_PIN = (1 << PTM_SHIFT) | PWM2E, // LED_R (through MTU2) TIOC4A [T.B.D] PWM0_PIN,
PWM1_PIN = (0 << PTM_SHIFT) | PWM2F, // LED_G PWM1_PIN,
PWM2_PIN = (0 << PTM_SHIFT) | PWM2G, // LED_B PWM2_PIN,
PWM3_PIN = (0 << PTM_SHIFT) | PWM2H, // LED_USER (not explicitly supported) PWM3_PIN,
PWM4_PIN = (0 << PTM_SHIFT) | PWM1G, // D9 PWM4_PIN,
PWM5_PIN = (0 << PTM_SHIFT) | PWM1H, // D8 not explicitly supported PWM5_PIN,
PWM6_PIN = (0 << PTM_SHIFT) | PWM1F, // D7 not explicitly supported PWM6_PIN,
PWM7_PIN = (0 << PTM_SHIFT) | PWM1D, // D6 PWM7_PIN,
PWM8_PIN,
PWM9_PIN,
PWM10_PIN,
PWM11_PIN,
PWM12_PIN,
} PWMName; } PWMName;
typedef enum { typedef enum {

5
libraries/mbed/targets/hal/TARGET_RENESAS/TARGET_RZ_A1H/objects.h
View File

@ -58,9 +58,8 @@ struct serial_s {
}; };
struct pwmout_s { struct pwmout_s {
__IO uint16_t *MR; uint32_t ch;
__IO uint16_t *CY; int32_t period;
uint16_t flag;
PWMName pwm; PWMName pwm;
}; };

240
libraries/mbed/targets/hal/TARGET_RENESAS/TARGET_RZ_A1H/pwmout_api.c
View File

@ -17,114 +17,134 @@
#include "pwmout_api.h" #include "pwmout_api.h"
#include "cmsis.h" #include "cmsis.h"
#include "pinmap.h" #include "pinmap.h"
#include "RZ_A1_Init.h"
#include "cpg_iodefine.h" #include "cpg_iodefine.h"
#include "pwm_iodefine.h" #include "pwm_iodefine.h"
#define TCR_CNT_EN 0x00000001
#define TCR_RESET 0x00000002
// PORT ID, PWM ID, Pin function // PORT ID, PWM ID, Pin function
static const PinMap PinMap_PWM[] = { static const PinMap PinMap_PWM[] = {
{LED_RED , 0, 4}, {P4_4 , PWM0_PIN , 4},
{LED_GREEN, 1, 7}, {P3_2 , PWM1_PIN , 7},
{LED_BLUE , 2, 4}, {P4_6 , PWM2_PIN , 4},
{P4_7 , 3, 4}, {P4_7 , PWM3_PIN , 4},
{P8_14 , 4, 6}, {P8_14 , PWM4_PIN , 6},
{P8_15 , 5, 6}, {P8_15 , PWM5_PIN , 6},
{P8_13 , 6, 6}, {P8_13 , PWM6_PIN , 6},
{P8_11 , 7, 6}, {P8_11 , PWM7_PIN , 6},
{P8_8 , PWM8_PIN , 6},
{P10_0 , PWM9_PIN , 3},
{P8_12 , PWM10_PIN, 6},
{P8_9 , PWM11_PIN, 6},
{P8_10 , PWM12_PIN, 6},
{NC, NC, 0} {NC, NC, 0}
}; };
static __IO uint16_t PORT[] = { static PWMType PORT[] = {
PWM2E, PWM2E, // PWM0_PIN
PWM2C, PWM2C, // PWM1_PIN
PWM2G, PWM2G, // PWM2_PIN
PWM2H, PWM2H, // PWM3_PIN
PWM1G, PWM1G, // PWM4_PIN
PWM1H, PWM1H, // PWM5_PIN
PWM1F, PWM1F, // PWM6_PIN
PWM1D, PWM1D, // PWM7_PIN
PWM1A, // PWM8_PIN
PWM2A, // PWM9_PIN
PWM1E, // PWM10_PIN
PWM1B, // PWM11_PIN
PWM1C, // PWM12_PIN
}; };
static __IO uint16_t *PWM_MATCH[] = { static __IO uint16_t *PWM_MATCH[] = {
&PWMPWBFR_2E, &PWMPWBFR_2E, // PWM0_PIN
&PWMPWBFR_2C, &PWMPWBFR_2C, // PWM1_PIN
&PWMPWBFR_2G, &PWMPWBFR_2G, // PWM2_PIN
&PWMPWBFR_2G, &PWMPWBFR_2G, // PWM3_PIN
&PWMPWBFR_1G, &PWMPWBFR_1G, // PWM4_PIN
&PWMPWBFR_1G, &PWMPWBFR_1G, // PWM5_PIN
&PWMPWBFR_1E, &PWMPWBFR_1E, // PWM6_PIN
&PWMPWBFR_1C, &PWMPWBFR_1C, // PWM7_PIN
&PWMPWBFR_1A, // PWM8_PIN
&PWMPWBFR_2A, // PWM9_PIN
&PWMPWBFR_1E, // PWM10_PIN
&PWMPWBFR_1A, // PWM11_PIN
&PWMPWBFR_1C, // PWM12_PIN
}; };
#define TCR_PWM_EN 0x00000008 static uint16_t init_period_ch1 = 0;
static uint16_t init_period_ch2 = 0;
static unsigned int pwm_clock_mhz;
void pwmout_init(pwmout_t* obj, PinName pin) { void pwmout_init(pwmout_t* obj, PinName pin) {
// determine the channel // determine the channel
PWMName pwm = (PWMName)pinmap_peripheral(pin, PinMap_PWM); PWMName pwm = (PWMName)pinmap_peripheral(pin, PinMap_PWM);
MBED_ASSERT(pwm != (PWMName)NC); MBED_ASSERT(pwm != (PWMName)NC);
obj->pwm = pwm;
obj->MR = PWM_MATCH[pwm];
obj->flag = (PORT[pwm]&1)<<12;
// power on // power on
CPGSTBCR3 &= ~(1<<0); CPGSTBCR3 &= ~(1<<0);
// clk mode settings PWM mode obj->pwm = pwm;
PWMPWCR_1_BYTE_L = 0xc4; if (((uint32_t)PORT[obj->pwm] & 0x00000010) != 0) {
PWMPWCR_2_BYTE_L = 0xc4; obj->ch = 2;
// output settings
PWMPWPR_1_BYTE_L = 0x00;
PWMPWPR_2_BYTE_L = 0x00; PWMPWPR_2_BYTE_L = 0x00;
} else {
// cycle reg. obj->ch = 1;
PWMPWCYR_1 = 0x3ff; PWMPWPR_1_BYTE_L = 0x00;
PWMPWCYR_2 = 0x3ff; }
//pwm_clock_mhz = SystemCoreClock / 4000000;
PWMPWCR_1_BYTE_L = 0xcc;
PWMPWCR_2_BYTE_L = 0xcc;
// default to 20ms: standard for servos, and fine for e.g. brightness control
//pwmout_period_ms(obj, 20);
//pwmout_write (obj, 0);
// Wire pinout // Wire pinout
pinmap_pinout(pin, PinMap_PWM); pinmap_pinout(pin, PinMap_PWM);
// default to 491us: standard for servos, and fine for e.g. brightness control
pwmout_write(obj, 0);
if ((obj->ch == 2) && (init_period_ch2 == 0)) {
pwmout_period_us(obj, 491);
init_period_ch2 = 1;
}
if ((obj->ch == 1) && (init_period_ch1 == 0)) {
pwmout_period_us(obj, 491);
init_period_ch1 = 1;
}
} }
void pwmout_free(pwmout_t* obj) { void pwmout_free(pwmout_t* obj) {
// [TODO] pwmout_write(obj, 0);
} }
void pwmout_write(pwmout_t* obj, float value) { void pwmout_write(pwmout_t* obj, float value) {
uint32_t wk_cycle;
uint16_t v;
if (value < 0.0f) { if (value < 0.0f) {
value = 0.0; value = 0.0f;
} else if (value > 1.0f) { } else if (value > 1.0f) {
value = 1.0; value = 1.0f;
} else {
// Do Nothing
}
if (obj->ch == 2) {
wk_cycle = PWMPWCYR_2 & 0x03ff;
} else {
wk_cycle = PWMPWCYR_1 & 0x03ff;
} }
// set channel match to percentage // set channel match to percentage
uint16_t v = (uint32_t)((float)0x3ff* value); v = (uint16_t)((float)wk_cycle * value);
*PWM_MATCH[obj->pwm] = (v | ((PORT[obj->pwm] & 1) << 12));
v |= (obj->flag);
// workaround for PWM1[1] - Never make it equal MR0, else we get 1 cycle dropout
*obj->MR = v;
// accept on next period start
//LPC_PWM1->LER |= 1 << obj->pwm;
} }
float pwmout_read(pwmout_t* obj) { float pwmout_read(pwmout_t* obj) {
float v = (float)((*obj->MR&0x3ff)) / 0x3ff; uint32_t wk_cycle;
return (v > 1.0f) ? (1.0f) : (v); float value;
if (obj->ch == 2) {
wk_cycle = PWMPWCYR_2 & 0x03ff;
} else {
wk_cycle = PWMPWCYR_1 & 0x03ff;
}
value = ((float)(*PWM_MATCH[obj->pwm] & 0x03ff) / (float)wk_cycle);
return (value > 1.0f) ? (1.0f) : (value);
} }
void pwmout_period(pwmout_t* obj, float seconds) { void pwmout_period(pwmout_t* obj, float seconds) {
@ -135,21 +155,75 @@ void pwmout_period_ms(pwmout_t* obj, int ms) {
pwmout_period_us(obj, ms * 1000); pwmout_period_us(obj, ms * 1000);
} }
static void set_duty_again(__IO uint16_t *p_pwmpbfr, uint16_t last_cycle, uint16_t new_cycle){
uint16_t wk_pwmpbfr;
float value;
uint16_t v;
wk_pwmpbfr = *p_pwmpbfr;
value = ((float)(wk_pwmpbfr & 0x03ff) / (float)last_cycle);
v = (uint16_t)((float)new_cycle * value);
*p_pwmpbfr = (v | (wk_pwmpbfr & 0x1000));
}
// Set the PWM period, keeping the duty cycle the same. // Set the PWM period, keeping the duty cycle the same.
void pwmout_period_us(pwmout_t* obj, int us) { void pwmout_period_us(pwmout_t* obj, int us) {
// calculate number of ticks uint32_t pclk_base;
uint16_t ticks = 0x3ff * us; uint32_t wk_cycle;
uint16_t wk_last_cycle;
uint32_t wk_cks = 0;
// stop timer if (us > 491) {
*obj->MR = ticks; us = 491;
} else if (us < 1) {
us = 1;
} else {
// Do Nothing
}
// Scale the pulse width to preserve the duty ratio if (RZ_A1_IsClockMode0() == false) {
pclk_base = (uint32_t)CM1_RENESAS_RZ_A1_P0_CLK / 10000;
} else {
pclk_base = (uint32_t)CM0_RENESAS_RZ_A1_P0_CLK / 10000;
}
// set the channel latch to update value at next period start wk_cycle = pclk_base * us;
// LPC_PWM1->LER |= 1 << 0; while (wk_cycle >= 102350) {
wk_cycle >>= 1;
wk_cks++;
}
wk_cycle = (wk_cycle + 50) / 100;
// enable counter and pwm, clear reset if (obj->ch == 2) {
// LPC_PWM1->TCR = TCR_CNT_EN | TCR_PWM_EN; wk_last_cycle = PWMPWCYR_2 & 0x03ff;
PWMPWCR_2_BYTE_L = 0xc0 | wk_cks;
PWMPWCYR_2 = (uint16_t)wk_cycle;
// Set duty again
set_duty_again(&PWMPWBFR_2A, wk_last_cycle, wk_cycle);
set_duty_again(&PWMPWBFR_2C, wk_last_cycle, wk_cycle);
set_duty_again(&PWMPWBFR_2E, wk_last_cycle, wk_cycle);
set_duty_again(&PWMPWBFR_2G, wk_last_cycle, wk_cycle);
// Counter Start
PWMPWCR_2_BYTE_L |= 0x08;
} else {
wk_last_cycle = PWMPWCYR_1 & 0x03ff;
PWMPWCR_1_BYTE_L = 0xc0 | wk_cks;
PWMPWCYR_1 = (uint16_t)wk_cycle;
// Set duty again
set_duty_again(&PWMPWBFR_1A, wk_last_cycle, wk_cycle);
set_duty_again(&PWMPWBFR_1C, wk_last_cycle, wk_cycle);
set_duty_again(&PWMPWBFR_1E, wk_last_cycle, wk_cycle);
set_duty_again(&PWMPWBFR_1G, wk_last_cycle, wk_cycle);
// Counter Start
PWMPWCR_1_BYTE_L |= 0x08;
}
// Save for future use
obj->period = us;
} }
void pwmout_pulsewidth(pwmout_t* obj, float seconds) { void pwmout_pulsewidth(pwmout_t* obj, float seconds) {
@ -161,14 +235,6 @@ void pwmout_pulsewidth_ms(pwmout_t* obj, int ms) {
} }
void pwmout_pulsewidth_us(pwmout_t* obj, int us) { void pwmout_pulsewidth_us(pwmout_t* obj, int us) {
// calculate number of ticks float value = (float)us / (float)obj->period;
uint32_t v = pwm_clock_mhz * us; pwmout_write(obj, value);
// workaround for PWM1[1] - Never make it equal MR0, else we get 1 cycle dropout
// set the match register value
*obj->MR = v;
// set the channel latch to update value at next period start
//LPC_PWM1->LER |= 1 << obj->pwm;
} }