Vision: Add camera to block publisher, implement target_solver