Added a sample fusion(6DOF)

need to go through code and remove the section which are not used