Added unit tests for kinematic functions