Added servo pin hardware setup code