Fix krl script
Fix $STIFFNESS modification
Add Example kinematic controller