Hello,
Awesome project. I've been building one also, but with stepper instead of servo motors. I'm a bit stuck with putting everything from matlab to arduino as the math is quite messy. Mind you sharing your code? My @mail is sharas.s@gmail.com
Regards,
Sharapolas