changed to arduino servo library from register writing