changed servo freq to 40Hz