inserted right hand skeleton parameters.
Still need to ask weihua on how to control heading via stateflow.