Marine Electronics Questions? Ask a Technician for Answers ASAP
$4000 is about average for a decent AutoPilot system for a 40' vessel.
You could perhaps negotiate on the labor costs for fitting - I would expect around $1000 should be enough.
You could get cheaper by fitting a used system, however they are usually removed and sold for a reason, so you really are better off investing in a new one with full manufacturer's warranty.