Pseudo-code for Servo module
*********************************************************************************************

AllPorts_Init
//Takes no input, returns nothing
	Setup ports A - E by enabling peripheral clock
End AllPorts_Init

AllServos_Init
//Takes no input, returns nothing
	Initialize 6 pins/channels as PWM
	Set PWM Period of 20 ms on Channels 0 and 1
	Set PWM Pulse Width to Set Servo Angle to 0 Degree on Channel 2
End AllServos_Init

TotServoReset
//Takes no input, returns nothing
	Set PWM Pulse Width to Set Servo Angle to 0 Degree on Channel 2
End TotServoReset

TotServoRelease
//Takes no input, returns nothing
	Set PWM Pulse Width to Set Servo Angle to 90 Degree on Channel 2
End TotServoRelease