Towards a COLREGS compliant autonomous surface vessel