clean up and add implement threading
fix indentation + add doc strings
add docstrings and remove old imports
add ServoController + add thread locks