Mechatronics Senior Project: Parallel Scara Robot Demo Code