Implemented more keyboard controls. Added joint_states subscriber.