Fix deg to rad conversion bug and set ports for roboteqs