Thanks for mentioning the control problems. Actually I don't really like current control scheme, it still needs adjustments. So I will work on it.
