Working leg tracking
Fixed last commit - leg tracking