points to SCARA + processing reprentatie
Clean up code and split up code base in different files