add blocking function for smoother arm motion
+ some refactor stuff