add trajectory plotting in degree
minor fixes
add some comment to switch points plotting