First implementation of P-element

First try to implement P-Element of PID-Controller located in ControlRST.java
Veriables with an underscore and an l egs. thisIsAVariable_l are  defined for the lego sensors.