请问如何给ardusub添加摄像头算法

请问如何给ardusub添加摄像头算法,有matlab水下图像增强算法,但是完全不会添加,个人感觉应该是添加在树莓派里面,但是具体就不知道了~求教