Fixed bug with rodrigues