Instrumentation / SRVCTL

SRVCTL - Sets period required to handle a servo motor, - Provides a APIs to move the servo motor in order to change car direction.

Dependents:   frdm_MasterVehicle

srvctl.cpp

Committer:
JalilChavez
Date:
2014-10-17
Revision:
1:b76be70801ed
Parent:
0:b0455b6a805a

File content as of revision 1:b76be70801ed:

#include "srvctl.h"

/**********************************************************************************
* Object declaration
***********************************************************************************/
PwmOut SRVCTL__xServo(PTD0);

void SRVCTL_vInit(void)
{
    /* Set the period required to move the servomotor */
    SRVCTL__xServo.period_ms(SERVO_PERIOD);
}

void SRVCTL_vSetPosition( uint16_t u16PosVal, const uint16_t u16MaxVal )
{
    uint16_t u16PulseWidth = MIDDLE_POINT;
    /* Adapt value to write into pwm channel */
    u16PulseWidth = START_POS + ( (FINAL_POS - START_POS) / u16MaxVal ) * (u16PosVal);
    /* Set duty cycle */
    SRVCTL__xServo. pulsewidth_us(u16PulseWidth);
}