Got translation and scaling of rigid bodies working