TP Controller corrections 1

Fixed floating bug in forward movement