Fixed ServoHandler. Added method Exit().

Signed-off-by: Thomas Helmke <thomas.helmke@gmx.de>