Hybrid Force Motion Control with Estimated Surface Normal for Manufacturing Applications