Remove servo write code until it has been testd in an actual servo without frying it.