Changed some datatypes
Added Motor Thread Functions