Pan Tilt mechanism working

Issue with azimuth and inclination very close solved