added control parameters
vision module
extract sonar measurement from INS
use sonar and tune vision gains
add vision stabilization messages