Pilz is doing some interesting work funded by RIC EU ROSIN (https://github.com/PilzDE/pilz_industrial_motion/tree/kinetic-devel/pilz_trajectory_generation). It looks like they are creating a library that generates trajectories for waypoint (with corner radii) paths. This might be useful from a library concept. They've also incorporated MoveIt with their own message set. This might also be of interest.
Suggest someone follow up with @davetcoleman for a quick discussion since he might be more familiar with the project and it's goals.