rotate

fun rotate(amount: Double, pivot: Pose = Pose(0.0,0.0,0.0))

Rotate the position of the pose around a pivot. NOTE: This does not affect the R value of the pose

Parameters

amount

Amount to rotate

pivot

position to pivot around