Edge Tracking pos update Fixed.

Fixed bug with edge tracking where we did not account for orientation
when doing the position update.