I have a 1994 40.5 with an Autohelm 4000 autopilot. The control head has failed and Raymarine has advised that they do not service this unit any longer and suggested replacement of the entire system with a rebuilt 6002 unit. 1. Any suggestions on a source for fixing or replacing the original 2000 control head?2. Has anyone installed a Raymarine Autohelm 6002 system in a 40.5?