update after physics
debug path
finish simplify path