Created OS_FREE function

Note: decfsz FSR0 will not detect beginning of allocated memory, issue
must be fixed in both OS_MALLOC and OS_FREE functions