Added the calculate area function. It is not tested. Been having PIC issues with the sensors on the motor PIC.