Implement lateral position controller filter

[mandrews281]

Need to implement a filter like the HoldYawFilter that takes the lateral target position and adjusts the lateral joystick input to drive the target lateral position to zero while holding the Yaw to a defined position.