made joystick node now publish to /vel_cmd_tbf
fixed bugs in while reorganizing filters package and tranforming image scans to sonar array reference frame