Solve crash problem and added floating joint