Pids added to controller class fixed error with sensor fuctions made motor accept doubles instead of ints