Let me know if you need any help with the math. I am very good at modeling, system identification, control theory and simulation. If you want local help, you might contact some one at IIT which is India's equivalent to the US MIT. I am also well known in industrial circles for testing.