Complete code reorganize

made easier to understand
added mapping to tablet screen coordinates
Adjusted servo constraints

to match changes made in Processing