add comments for captors.c/.h and correct comments of tools_lib.h
Re-add servoSetSpeed and flapConfig