#!/bin/sh

# Get CPU count
CPU_COUNT=1
STATUS_FLAGS=$(i2cget -y 12 0x31 0x7)
if [ $? != 0 ]; then
	STATUS_FLAGS=$(i2cget -y 12 0x31 0x7)
fi
if [ $? != 0 ]; then
	STATUS_FLAGS=$(i2cget -y 12 0x31 0x7)
fi
CPU_PRESENT_FLAG_N=$(( ${STATUS_FLAGS} & 0x20 ))
if [ $CPU_PRESENT_FLAG_N != 0 ]; then
	CPU_COUNT=$(( ${CPU_COUNT} + 1 ))
fi
echo "Found $CPU_COUNT CPU(s)"

i2cset -y 4 0x70 0x00 0x00 b    # VDD 0  - PAGE set
i2cset -y 4 0x70 0x01 0x80 b    # VDD 0
i2cset -y 4 0x70 0x00 0x01 b    # VCS 0  - PAGE set
i2cset -y 4 0x70 0x01 0x80 b    # VCS 0
i2cset -y 4 0x70 0x00 0x00 b    # VCS 0  - PAGE reset
i2cset -y 4 0x73 0x00 0x00 b    # VDN 0  - PAGE set
i2cset -y 4 0x73 0x01 0x80 b    # VDN 0

if [ $CPU_COUNT -gt 1 ]; then
	i2cset -y 5 0x70 0x00 0x00 b    # VDD 1  - PAGE set
	i2cset -y 5 0x70 0x01 0x80 b    # VDD 1
	i2cset -y 5 0x70 0x00 0x01 b    # VCS 1  - PAGE set
	i2cset -y 5 0x70 0x01 0x80 b    # VCS 1
	i2cset -y 5 0x70 0x00 0x00 b    # VCS 1  - PAGE reset
	i2cset -y 5 0x73 0x00 0x00 b    # VDN 1  - PAGE set
	i2cset -y 5 0x73 0x01 0x80 b    # VDN 1
fi