SSC interface vehicle_kinematic_state: Tests & fixes

Description

Implemented two tests for calculation of the x/y coordinates from steering angle and velocity/acceleration, and as a result fixed two issues:

• When steering was (close to) 0, a division by 0 would occur. There is now a special path for these cases.
• Some terms used the wrong trigonometric function

Checklist

• Documentation was updated