If you have an algorithm,you can write it in PicBasic easily. Decide what you need how you do processes and use logic comparison statement (if then etc.)
and create neccessary labels to minimize your code.

Pic Basic Forum community will help you, if you start writing your code