First, I thought, after made a drawing post #315 then wrote a codeEDIT: answering dj's post but again, you are coding first, not last. Figure out the solution FIRST, then code it. It also looks like the code you edited is not the latest version. Hard to keep up with that..
I mentioned there it's not original its pseudocode,
I thought that if this method works then I can go for further steps. Combining all together makes it difficult for me
I am looking to integrate code in 331 latest version