dualmanipulation: remove manually adding initial trajectory point (fixes #325)
dualmanipulation: fix neighstatefn "DualArmConstraint"

For one, we cannot compare joints of vprev(vnew) with vsolution directly,
we need to use SubtractDOFValues to consider circular joints.

Secondly, we first check if vprev+vdelta fulfils the constraint, before
using FindIkSolution and check that solution. Otherwise, RRT's _InitPlan
might already fail, because params->Validate() fails (the IK solution
is further away than expected). Maybe this is because FindIkSolution does
not return the closest solution and we would need to filter all solutions,
but so far this method works.

Also removed some unused variables.
Merge pull request #326 from kb0n/dualmanipulation_fix

Dualmanipulation fix
fix collada writer to output only 3 values for color, reader reads only 3 values (4th was meaningless anyway)
Merge branch 'production' of https://github.com/rdiankov/openrave into production
writing/reading 4th channel of color in collada according to spec. transparency still overwrites all when reading
Merge branch 'master' of https://github.com/rdiankov/openrave