Moved ServoController into hardware