wip
found jean-claude latombe implementation of reeds shepp

do proof reading with current
version