Ghafarnia, N., Department of Mechatronics, Tehran University, Iran