Hard coded to size dimensions fixed and referenced to parameters file. This was the discrepancy between inverse and forward kinematics discussed on 20/08/14.

Signed-off-by: JHolland <jonathan.holland8@gmail.com>