void bitstuffFrame(unsigned char *inputBuffer, int length,
                   unsigned char *outputBuffer) {
  long numberOfBits = 0;
  int noOfConOnes = 0;
  for (int i = 0; i < length; i++) {
    for (int b = 0; b < 8; b++) {
      if ((numberOfBits & 0x07) == 0)
        outputBuffer[numberOfBits >> 3] = 0;
      unsigned char bit = inputBuffer[i] & (0x01 << b);
      if (bit) {
        noOfConOnes++;
      } else {
        noOfConOnes = 0;
      }
      if (noOfConOnes == 5) {
        numberOfBits++;
        if ((numberOfBits & 0x07) == 0)
          outputBuffer[numberOfBits >> 3] = 0;
        noOfConOnes = 0;
      }
      outputBuffer[numberOfBits >> 3] = inputBuffer[i] | bit;
      numberOfBits++;
    }
  }
}


x86 assembly (clang, -O0):
<bitstuffFrame>:
push   %rbp
mov    %rsp,%rbp
mov    %rdi,-0x8(%rbp)
mov    %esi,-0xc(%rbp)
mov    %rdx,-0x18(%rbp)
movq   $0x0,-0x20(%rbp)
movl   $0x0,-0x24(%rbp)
movl   $0x0,-0x28(%rbp)
mov    -0x28(%rbp),%eax
cmp    -0xc(%rbp),%eax
jge    122f <bitstuffFrame+0x12f>
movl   $0x0,-0x2c(%rbp)
cmpl   $0x8,-0x2c(%rbp)
jge    121c <bitstuffFrame+0x11c>
mov    -0x20(%rbp),%rax
and    $0x7,%rax
cmp    $0x0,%rax
jne    1164 <bitstuffFrame+0x64>
mov    -0x18(%rbp),%rax
mov    -0x20(%rbp),%rcx
sar    $0x3,%rcx
movb   $0x0,(%rax,%rcx,1)
mov    -0x8(%rbp),%rax
movslq -0x28(%rbp),%rcx
movzbl (%rax,%rcx,1),%eax
mov    -0x2c(%rbp),%ecx
mov    $0x1,%edx
shl    %cl,%edx
mov    %edx,%ecx
and    %ecx,%eax
mov    %al,-0x2d(%rbp)
cmpb   $0x0,-0x2d(%rbp)
je     1199 <bitstuffFrame+0x99>
mov    -0x24(%rbp),%eax
add    $0x1,%eax
mov    %eax,-0x24(%rbp)
jmp    11a0 <bitstuffFrame+0xa0>
movl   $0x0,-0x24(%rbp)
cmpl   $0x5,-0x24(%rbp)
jne    11df <bitstuffFrame+0xdf>
mov    -0x20(%rbp),%rax
add    $0x1,%rax
mov    %rax,-0x20(%rbp)
mov    -0x20(%rbp),%rax
and    $0x7,%rax
cmp    $0x0,%rax
jne    11d8 <bitstuffFrame+0xd8>
mov    -0x18(%rbp),%rax
mov    -0x20(%rbp),%rcx
sar    $0x3,%rcx
movb   $0x0,(%rax,%rcx,1)
movl   $0x0,-0x24(%rbp)
mov    -0x8(%rbp),%rax
movslq -0x28(%rbp),%rcx
movzbl (%rax,%rcx,1),%eax
movzbl -0x2d(%rbp),%ecx
or     %ecx,%eax
mov    %al,%dl
mov    -0x18(%rbp),%rax
mov    -0x20(%rbp),%rcx
sar    $0x3,%rcx
mov    %dl,(%rax,%rcx,1)
mov    -0x20(%rbp),%rax
add    $0x1,%rax
mov    %rax,-0x20(%rbp)
mov    -0x2c(%rbp),%eax
add    $0x1,%eax
mov    %eax,-0x2c(%rbp)
jmp    1138 <bitstuffFrame+0x38>
jmp    1221 <bitstuffFrame+0x121>
mov    -0x28(%rbp),%eax
add    $0x1,%eax
mov    %eax,-0x28(%rbp)
jmp    1125 <bitstuffFrame+0x25>
pop    %rbp
ret

x86 assembly (clang, -O2):
<bitstuffFrame>:
push   %rbx
test   %esi,%esi
jle    1194 <bitstuffFrame+0x94>
mov    %esi,%r8d
xor    %r9d,%r9d
xor    %r10d,%r10d
xor    %esi,%esi
xor    %r11d,%r11d
jmp    1129 <bitstuffFrame+0x29>
nopl   0x0(%rax)
add    $0x1,%r10
cmp    %r8,%r10
je     1194 <bitstuffFrame+0x94>
xor    %ecx,%ecx
jmp    1148 <bitstuffFrame+0x48>
nopl   (%rax)
or     %bl,%al
mov    %rsi,%rbx
sar    $0x3,%rbx
mov    %al,(%rdx,%rbx,1)
add    $0x1,%rsi
add    $0x1,%ecx
cmp    $0x8,%ecx
je     1120 <bitstuffFrame+0x20>
test   $0x7,%sil
jne    1159 <bitstuffFrame+0x59>
mov    %rsi,%rax
sar    $0x3,%rax
movb   $0x0,(%rdx,%rax,1)
movzbl (%rdi,%r10,1),%eax
mov    $0x1,%ebx
shl    %cl,%ebx
add    $0x1,%r11d
and    %al,%bl
cmove  %r9d,%r11d
cmp    $0x5,%r11d
jne    1130 <bitstuffFrame+0x30>
add    $0x1,%rsi
xor    %r11d,%r11d
test   $0x7,%sil
jne    1130 <bitstuffFrame+0x30>
mov    %rsi,%rax
sar    $0x3,%rax
movb   $0x0,(%rdx,%rax,1)
movzbl (%rdi,%r10,1),%eax
jmp    1130 <bitstuffFrame+0x30>
pop    %rbx
ret

LLVM IR (-O0):
define void @bitstuffFrame(i8* %0, i32 %1, i8* %2) {
%4 = alloca i8*
%5 = alloca i32
%6 = alloca i8*
%7 = alloca i64
%8 = alloca i32
%9 = alloca i32
%10 = alloca i32
%11 = alloca i8
store i8* %0, i8** %4
store i32 %1, i32* %5
store i8* %2, i8** %6
store i64 0, i64* %7
store i32 0, i32* %8
store i32 0, i32* %9
br label %12
12: ; preds = %82, %3
%13 = load i32, i32* %9
%14 = load i32, i32* %5
%15 = icmp slt i32 %13, %14
br i1 %15, label %16, label %85
16: ; preds = %12
store i32 0, i32* %10
br label %17
17: ; preds = %78, %16
%18 = load i32, i32* %10
%19 = icmp slt i32 %18, 8
br i1 %19, label %20, label %81
20: ; preds = %17
%21 = load i64, i64* %7
%22 = and i64 %21, 7
%23 = icmp eq i64 %22, 0
br i1 %23, label %24, label %29
24: ; preds = %20
%25 = load i8*, i8** %6
%26 = load i64, i64* %7
%27 = ashr i64 %26, 3
%28 = getelementptr inbounds i8, i8* %25, i64 %27
store i8 0, i8* %28
br label %29
29: ; preds = %24, %20
%30 = load i8*, i8** %4
%31 = load i32, i32* %9
%32 = sext i32 %31 to i64
%33 = getelementptr inbounds i8, i8* %30, i64 %32
%34 = load i8, i8* %33
%35 = zext i8 %34 to i32
%36 = load i32, i32* %10
%37 = shl i32 1, %36
%38 = and i32 %35, %37
%39 = trunc i32 %38 to i8
store i8 %39, i8* %11
%40 = load i8, i8* %11
%41 = icmp ne i8 %40, 0
br i1 %41, label %42, label %45
42: ; preds = %29
%43 = load i32, i32* %8
%44 = add nsw i32 %43, 1
store i32 %44, i32* %8
br label %46
45: ; preds = %29
store i32 0, i32* %8
br label %46
46: ; preds = %45, %42
%47 = load i32, i32* %8
%48 = icmp eq i32 %47, 5
br i1 %48, label %49, label %61
49: ; preds = %46
%50 = load i64, i64* %7
%51 = add nsw i64 %50, 1
store i64 %51, i64* %7
%52 = load i64, i64* %7
%53 = and i64 %52, 7
%54 = icmp eq i64 %53, 0
br i1 %54, label %55, label %60
55: ; preds = %49
%56 = load i8*, i8** %6
%57 = load i64, i64* %7
%58 = ashr i64 %57, 3
%59 = getelementptr inbounds i8, i8* %56, i64 %58
store i8 0, i8* %59
br label %60
60: ; preds = %55, %49
store i32 0, i32* %8
br label %61
61: ; preds = %60, %46
%62 = load i8*, i8** %4
%63 = load i32, i32* %9
%64 = sext i32 %63 to i64
%65 = getelementptr inbounds i8, i8* %62, i64 %64
%66 = load i8, i8* %65
%67 = zext i8 %66 to i32
%68 = load i8, i8* %11
%69 = zext i8 %68 to i32
%70 = or i32 %67, %69
%71 = trunc i32 %70 to i8
%72 = load i8*, i8** %6
%73 = load i64, i64* %7
%74 = ashr i64 %73, 3
%75 = getelementptr inbounds i8, i8* %72, i64 %74
store i8 %71, i8* %75
%76 = load i64, i64* %7
%77 = add nsw i64 %76, 1
store i64 %77, i64* %7
br label %78
78: ; preds = %61
%79 = load i32, i32* %10
%80 = add nsw i32 %79, 1
store i32 %80, i32* %10
br label %17
81: ; preds = %17
br label %82
82: ; preds = %81
%83 = load i32, i32* %9
%84 = add nsw i32 %83, 1
store i32 %84, i32* %9
br label %12
85: ; preds = %12
ret void
}

LLVM IR (-O2):
define void @bitstuffFrame(i8* nocapture %0, i32 %1, i8* nocapture writeonly %2) {
%4 = icmp sgt i32 %1, 0
br i1 %4, label %5, label %12
5: ; preds = %3
%6 = zext i32 %1 to i64
br label %7
7: ; preds = %5, %13
%8 = phi i64 [ 0, %5 ], [ %14, %13 ]
%9 = phi i64 [ 0, %5 ], [ %49, %13 ]
%10 = phi i32 [ 0, %5 ], [ %44, %13 ]
%11 = getelementptr inbounds i8, i8* %0, i64 %8
br label %16
12: ; preds = %13, %3
ret void
13: ; preds = %42
%14 = add nuw nsw i64 %8, 1
%15 = icmp eq i64 %14, %6
br i1 %15, label %12, label %7
16: ; preds = %7, %42
%17 = phi i64 [ %9, %7 ], [ %49, %42 ]
%18 = phi i32 [ 0, %7 ], [ %50, %42 ]
%19 = phi i32 [ %10, %7 ], [ %44, %42 ]
%20 = and i64 %17, 7
%21 = icmp eq i64 %20, 0
br i1 %21, label %22, label %25
22: ; preds = %16
%23 = ashr i64 %17, 3
%24 = getelementptr inbounds i8, i8* %2, i64 %23
store i8 0, i8* %24
br label %25
25: ; preds = %22, %16
%26 = load i8, i8* %11
%27 = shl nuw nsw i32 1, %18
%28 = trunc i32 %27 to i8
%29 = and i8 %26, %28
%30 = icmp eq i8 %29, 0
%31 = add nsw i32 %19, 1
%32 = select i1 %30, i32 0, i32 %31
%33 = icmp eq i32 %32, 5
br i1 %33, label %34, label %42
34: ; preds = %25
%35 = add nsw i64 %17, 1
%36 = and i64 %35, 7
%37 = icmp eq i64 %36, 0
br i1 %37, label %38, label %42
38: ; preds = %34
%39 = ashr i64 %35, 3
%40 = getelementptr inbounds i8, i8* %2, i64 %39
store i8 0, i8* %40
%41 = load i8, i8* %11
br label %42
42: ; preds = %34, %38, %25
%43 = phi i8 [ %26, %25 ], [ %41, %38 ], [ %26, %34 ]
%44 = phi i32 [ %32, %25 ], [ 0, %38 ], [ 0, %34 ]
%45 = phi i64 [ %17, %25 ], [ %35, %38 ], [ %35, %34 ]
%46 = or i8 %43, %29
%47 = ashr i64 %45, 3
%48 = getelementptr inbounds i8, i8* %2, i64 %47
store i8 %46, i8* %48
%49 = add nsw i64 %45, 1
%50 = add nuw nsw i32 %18, 1
%51 = icmp eq i32 %50, 8
br i1 %51, label %13, label %16
}