finish kinematics test
add rviz config