Loop issues fixed + servo control functions

Fixed issues with frozen looping and added functions to control servo on
both arduino and C# side