Fix set_position and set_movement a bit
Better handling of set_position/set_movement
Minor change in physics