Added the stubs for the kinematics

I added functions for the forward and inverse position and velocity
kinematics. I also added a configuration struct for the robot.