pwmout - LPC176X - add read methods for period and pulsewidth

pull/13492/head
talorion 2020-08-25 23:45:26 +02:00 committed by Gregor Mayramhof
parent 7270f296d3
commit ea6e806a31
1 changed files with 50 additions and 31 deletions

View File

@ -29,12 +29,12 @@ static const PinMap PinMap_PWM[] = {
{P1_23, PWM_4, 2},
{P1_24, PWM_5, 2},
{P1_26, PWM_6, 2},
{P2_0 , PWM_1, 1},
{P2_1 , PWM_2, 1},
{P2_2 , PWM_3, 1},
{P2_3 , PWM_4, 1},
{P2_4 , PWM_5, 1},
{P2_5 , PWM_6, 1},
{P2_0, PWM_1, 1},
{P2_1, PWM_2, 1},
{P2_2, PWM_3, 1},
{P2_3, PWM_4, 1},
{P2_4, PWM_5, 1},
{P2_5, PWM_6, 1},
{P3_25, PWM_2, 3},
{P3_26, PWM_3, 3},
{NC, NC, 0}
@ -54,7 +54,8 @@ __IO uint32_t *PWM_MATCH[] = {
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
PWMName pwm = (PWMName)pinmap_peripheral(pin, PinMap_PWM);
MBED_ASSERT(pwm != (PWMName)NC);
@ -79,17 +80,19 @@ void pwmout_init(pwmout_t* obj, PinName pin) {
// default to 20ms: standard for servos, and fine for e.g. brightness control
pwmout_period_ms(obj, 20);
pwmout_write (obj, 0);
pwmout_write(obj, 0);
// Wire pinout
pinmap_pinout(pin, PinMap_PWM);
}
void pwmout_free(pwmout_t* obj) {
void pwmout_free(pwmout_t *obj)
{
// [TODO]
}
void pwmout_write(pwmout_t* obj, float value) {
void pwmout_write(pwmout_t *obj, float value)
{
if (value < 0.0f) {
value = 0.0;
} else if (value > 1.0f) {
@ -110,21 +113,25 @@ void pwmout_write(pwmout_t* obj, float value) {
LPC_PWM1->LER |= 1 << obj->pwm;
}
float pwmout_read(pwmout_t* obj) {
float pwmout_read(pwmout_t *obj)
{
float v = (float)(*obj->MR) / (float)(LPC_PWM1->MR0);
return (v > 1.0f) ? (1.0f) : (v);
}
void pwmout_period(pwmout_t* obj, float seconds) {
void pwmout_period(pwmout_t *obj, float seconds)
{
pwmout_period_us(obj, seconds * 1000000.0f);
}
void pwmout_period_ms(pwmout_t* obj, int ms) {
void pwmout_period_ms(pwmout_t *obj, int ms)
{
pwmout_period_us(obj, ms * 1000);
}
// 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 ticks = pwm_clock_mhz * us;
@ -146,15 +153,23 @@ void pwmout_period_us(pwmout_t* obj, int us) {
LPC_PWM1->TCR = TCR_CNT_EN | TCR_PWM_EN;
}
void pwmout_pulsewidth(pwmout_t* obj, float seconds) {
int pwmout_read_period_us(pwmout_t *obj)
{
return (float)(LPC_PWM1->MR0);
}
void pwmout_pulsewidth(pwmout_t *obj, float seconds)
{
pwmout_pulsewidth_us(obj, seconds * 1000000.0f);
}
void pwmout_pulsewidth_ms(pwmout_t* obj, int ms) {
void pwmout_pulsewidth_ms(pwmout_t *obj, int ms)
{
pwmout_pulsewidth_us(obj, ms * 1000);
}
void pwmout_pulsewidth_us(pwmout_t* obj, int us) {
void pwmout_pulsewidth_us(pwmout_t *obj, int us)
{
// calculate number of ticks
uint32_t v = pwm_clock_mhz * us;
@ -170,6 +185,10 @@ void pwmout_pulsewidth_us(pwmout_t* obj, int us) {
LPC_PWM1->LER |= 1 << obj->pwm;
}
int pwmout_read_pulsewidth_us(pwmout_t *obj {
return (timer->MR3 - timer->MR[tid.mr]);
}
const PinMap *pwmout_pinmap()
{
return PinMap_PWM;