Underwater robot guidance, navigation and control in fish net pens