Integrate path planning

[ahundt]

From @astrick3 on February 5, 2015 21:45

Acceptance test:

First need to Command arm to a series of locations and have it move via the inverse kinematics using the included lua scripts.

Copied from original issue: ahundt/robone#7

[ahundt]

I got stuck getting the inverse kinematics to work, so I asked on the v-rep forum. I need to implement the changes they described.

http://www.forum.coppeliarobotics.com/viewtopic.php?f=9&t=2867

[ahundt]

Can move relatively smoothly between points, doesn't grab.

Need to figure out a way to provide simulated target points in real time so we can eventually integrate that into real system.

[ahundt]

Grabbing works after updating to v-rep 3.2.0